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Abstract 

The  Air  Force  Institute  of  Technclogy(AFIT)  supports  on-going  research  in 
application  of  robotic  technology  to  enhance  assembly  tasks.  As  a  testbed,  A  FIT 
supports  the  ground-based  aerial  refueling  project,  with  an  emphasis  on  visual  ser- 
voing  techniques  and  compliant  motion  control.  This  thesis  focuses  on  compliant 
motion  control.  Previous  research  developed  the  testing  environment,  which  includes 
a  PUMA-560  industrial  manipulator,  and  a  half  scale  mock-up  of  an  aerial  refueling 
system.  This  effort  corrected  and  expanded  the  existing  two  degree  of  freedom(DOF) 
compliant  controller  to  three  DOF.  Three  DOF  compliance  was  demonstrated  by  in¬ 
serting  the  refueling  nozzle  into  the  receiver  port. Tuning,  carried  out  by  adjusting 
desired  model  variables,  characterized  the  impedance  controller  to  function  over  a 
wide  range  of  desired  dynamics.  In  addition,  irregular  force  and  velocity  torque 
profiles  were  attenuated  through  basic  filtering  schemes,  providing  an  environment 
in  which  friction  compensation  was  tested.  Finally,  preliminary  studies  into  faster 
trajectories  provide  impetus  for  further  study  in  the  area  of  high  speed  compliant 
assembly.  The  three  DOF  compliant  controller  combined  with  the  visual  servoing 
techniques,  provides  a  strong  environment  to  test  and  evaluate  robotic  technologies 
for  constrained  motion  assembly  tasks. 
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Three  Degrees  of  Freedom 
Compliant  Motion  Control 
for  Robotic  Aircraft  Refueling 


I.  Introduction 


1.1  Motivation 

One  method  to  augment  diminishing  work  force  and  protect  humans  from  hostile 
environments,  is  the  application  of  robotics  technology  to  specific  tasks.  Some  tasks 
currently  being  examined  include  robotic  aircraft  paint  stripping,  aircraft  radiogra¬ 
phy,  and  canopy  polishing.  These  applications  have  shown  the  potential  of  robotics 
to  improve  efficiency  and  reduce  manpower.  One  of  the  challenges  in  using  robotic 
technology  for  industrial  and  military  applications,  is  applying  only  technology  that 
has  been  proven  for  a  specific  scenario.  This  type  of  application  requires  directed 
and  specific  research  along  with  the  understanding  that  robots  are  not  capable  of  re¬ 
placing  all  or  even  most  of  the  human  applications.  Yet,  there  are  many  areas  where 
robotic  technology  can  contribute  significantly.  A  growing  area  of  interest  in  the 
robotic  community  is  constrained  motion  applications.  Constrained  motion  refers 
to  tasks  performed  while  in  contact  with  the  environment.  Humans  perform  most 
of  their  tasks  in  the  constrained  mode.  Present  generation  robots  perform  a  limited 
number  of  constrained  tasks  and  many  free  space  tasks.  In  the  cases  where  robots 
perform  constrained  tasks,  a  high  degree  of  task  planning,  robot  training,  and  rigid 
fixtu.ing  has  been  implemented  to  accomplish  the  task.  The  reason  for  such  efforts 
is  that  control  technology  for  such  robots  is  generally  based  on  individual  joint  high 
gain  proportional-derivative(PD)  or  proportional-integral-derivative(PID)  feedback. 
These  controllers  are  extremely  efficient  at  positioning  a  robot  at  a  desired  point 


1-1 


with  accuracy  and  repeatability.  When  the  same  controller  is  used  for  constrained 
tasks  catastrophic  results  can  and  usually  do  follow. 

There  are  many  reasons  humans  have  the  ability  to  perform  complicated  con¬ 
strained  tasks  effortlessly.  These  reasons  can  be  divided  into  three  categories:  Ability 
to  learn  and  recognize  objects  quickly;  Local  and  global  control  centers;  Compact 
'.nd  efficient  sensor  placement-  Humans  can  sense  and  react  to  many  things  like 
temperature,  texture,  and  forces.  It  is  the  ability  to  sense  and  react  to  forces  that 
make  human  manipulation  so  good  with  constraint  tasks.  A  simple  task  like  insert¬ 
ing  a  peg  into  a  hole  is  rather  basic  for  humans,  even  in  the  dark.  In  such  a  task  the 
human  will  touch  the  environment  and  follow  it  until  the  hole  is  contacted.  Once 
initially  contacted,  the  hand  adjusts  forces  to  allow  the  peg  to  engage  and  enter 
the  hole.  This  type  of  manipulation  task  is  often  referred  to  as  compliant  motion: 
the  ability  to  adjust  to  and  surmount  obstacles  while  performing  the  desired  task 
in  a  stable  manner.  The  peg-in-the-hole  task  is  representative  of  a  general  class  of 
assembly  operations.  As  shown  in  this  simple  example,  constrained  tasks  require  the 
ability  to  adjust  to  force  inputs.  Therefore,  for  robots  to  perform  constrained  tasks 
in  a  semi-  or  unstructured  environment,  force  centered  control  schemes  combined 
with  force  sensors  must  be  evaluated  and  applied.  Much  of  the  current  research  in 
robotics  is  involved  in  this  area  of  compliant  control. 

The  Air  Force  has  some  specific  and  unique  areas  of  interest  where  a  compliant 
task  oriented  robot  may  prove  useful.  Specifically,  part  sorting,  automated  struc¬ 
tural  analysis,  parts  replacement,  and  refueling  all  provide  potential  candidates  for 
robotics.  Each  of  these  tasks  can  be  dangerous  and  difficult  for  humans  to  perform  in 
a  chemical  or  hazardous  environment.  A  robot  in  the  same  environment,  if  appropri¬ 
ately  designed,  would  be  unaffected.  Currently,  AF1T  is  evaluating  aerial  refueling 
as  a  testbed  for  applying  robotics.  The  AFIT  robotic  refueling  scenario  is  divided 
into  two  general  areas:  pattern  recognition  and  compliant  motion. 

In  the  area  of  pattern  recognition,  research  by  Capt  Shipman  [40]  and  Capt 
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Bennett  [7]  has  provided  the  means  to  find  and  identify  the  standard  aircraft  refueling 
pert  through  digital  imaging  in  various  lighting  environments.  Once  the  port  has 
been  identified,  the  second  area  of  research,  constrained  motion,  is  applied  to  actually 
insert  the  refueling  nozzle  into  the  receiver.  Because  nozzle  insertion  is  analogous  to 
the  peg-in-the-hole  task  successfully  demonstrating  this  task  provides  insight  into 
use  of  robotics  for  constrained  Air  Force  applications. 

1.2  Objective 

AFIT  studies  in  compliant  motion  focus  on  the  feasibility  of  robotic  on-ground 
refueling  using  the  aerial  refueling  port.  This  method  provides  a  potential  for  faster 
turn-around  time  for  ground  refueling.  The  purpose  of  this  research  effort  is  to 
improve,  clarify,  and  expand  the  compliant  control  applications  previously  performed 
on  a  laboratory  mock-up  of  the  ground  refueling  scenario. 

1.3  Problem  Statement 

Past  research  at  AFIT  has  paved  the  way  for  a  full  three  degree  of  freedom(DOF) 
ground  refueling  scenario  demonstration.  Captain  Duvall  began  the  work  by  devel¬ 
oping  the  half  scale  mock-up  of  the  Universal  Aerial  Refueling  Receptacle  Slipway 
Installation(UARRSI)  port  and  nozzle,  along  with  the  tedious  work  of  characterizing 
the  basic  dynamics  and  control  laws  to  be  used  [14].  Additionally,  Duvall  developed 
the  initial  testbed  which  included  computer  programs  integrated  with  a  PUMA-560 
serial  link  industrial  robot,  and  he  performed  initial  testing  in  two  DOF.  Captain 
Milholen  followed  Duvall’s  efforts  by  refining  computer  code  and  improving  the  sys¬ 
tem  with  the  addition  of  a  faster  clock  [34].  With  these  improvements  Milholen  was 
able  to  demonstrate  two  DOF  refueling  tracking  and  insertion. 

The  goal  of  present  AFIT  studies  in  compliant  motion  is  to  demonstrate  three 
DOF  compliant  peg-in-the-hole  capability  by  means  of  the  ground  refueling  demon¬ 
stration.  This  follow-on  research  effort  is  centered  around  expanding  the  previous 
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experiments  from  two  DOF  capability  into  the  more  general  and  useful  three  DOF 
case.  At  first  glance,  this  by  itself  appears  to  be  simply  a  minor  adjustment  to  the 
previous  efforts.  However,  the  mechanism  for  implementing  the  two  DOF  controller 
contained  some  anomalies  which  needed  to  be  characterized  and  corrected  prior  to 
implementing  the  expanded  controller.  In  addition,  Milholen  recommended  further 
improvements  in  friction  compensation  and  second  order  mode)  parameter  selection. 

The  purpose  of  this  effort  is  to  characterize  and  correct  anomalies  in  the  two 
DOF  compliant  controller,  expand  the  control  to  thr°e  DOF,  and  provide  better 
performance  through  parameter  selection  or  ‘tuning’  and  friction  compensation. 

1.4  Method  of  Approach 

The  primary  emphasis  of  this  thesis  was  to  prove  and  demonstrate  three  DOF 
compliant  motion.  The  central  hurdle  was  characterizing  and  correcting  the  anoma¬ 
lies  from  the  two  DOF  implementation.  This  required  a  complete  evaluation  of  the 
theory  and  subsequent  computer  code  used  to  create  the  two  DOF  controller.  Each 
of  the  contributing  factors  in  the  control  method  such  as  dynamics,  kinematics,  and 
force  sensor  integration  was  evaluated  for  theoretical  and  applied  accuracy.  Follow¬ 
ing  this  evaluation  and  the  subsequent  corrections,  the  computer  code  was  upgraded 
to  the  three  DOF  form.  All  the  two- by-two  matrix  equations  were  expanded  to 
three-by-three  arrays.  Any  simplifying  assumptions  made  for  the  two  DOF  case 
were  removed.  Effectively,  the  inertia,  mass,  damping,  jacobian,  inverse  Jacobian, 
and  jacobian  transpose  terms  had  to  be  recalculated  then  coded  in  their  three  DOF 
form.  Once  coding  was  completed,  the  algorithm  was  exercised  using  the  ‘effective’ 
second  order  parameters  which  were  derived  from  the  two  DOF  case.  Next,  these 
parameters  were  adjusted  within  certain  limiting  bounds  to  evaluate  performance 
changes  due  to  this  adjustment  or  ‘tuning’. 

In  addition  to  tuning  the  second  order  model  parameters,  filters  on  force  and 
velocity  terms  were  applied  to  reduce  the  rough  noise- type  effects  noticed  dm  ag 
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the  tuning  process.  Next,  the  friction  model  used  by  Milholen  was  included  with 
the  control  law,  and  evaluated  for  effectiveness.  Finally,  some  preliminary  stud¬ 
ies  investigating  the  effect  of  increased  trajectory  speed  on  compliant  motion  were 
accomplished. 

1.5  Contributions 

This  thesis  has  provided  the  capability  to  perform  three  DOF  compliant  assembly- 
type  tasks,  by  demonstrating  ground  refueling  on  a  UARRSI  half  scale  mock-up. 
With  this  capability,  AFIT  can  better  assess  how  to  apply  robotic  technology  to  Air 
Force  issues.  In  addition  to  this  significant  advance,  additional  important  contribu¬ 
tions  include: 

•  resolution  of  anomalies  in  the  two  DOF  impedance  control  law  implementation 

•  identification  and  resolution  of  improper  force  sensor  coordinate  frames 

•  characterization  of  impedance  control  robustness  to  wide  variations  in  natural 
frequency  and  damping  terms 

•  illustration  of  impedance  control  capability  at  much  greater  velocities 

These  capabilities  provide  insight  for  on-going  Air  Force  research  into  applying 
robotics  to  support  the  demands  of  increased  efficiency  with  a  reduced  work  force. 

1.6  Organization 

This  thesis  is  organized  into  six  chapters.  Chapter  two  provides  a  summary 
of  the  salient  literature  regarding  force  control  theory  and  applications,  including 
friction  characteristics  and  effects.  Chapter  three  identifies  the  test  environment 
hardware  and  software.  Chapter  four  points  out  the  anomalies  encountered  and  how 
they  were  corrected.  Chapter  five  discusses  the  test  results.  Finally,  chapter  six 
concludes  with  summary  comments  and  some  recommendations  for  future  research 
efforts  in  this  area. 
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II.  Literature  Review 


2.1  Motivation  and  Scope 

Currently,  a  majority  of  robotic  applications  are  centered  around  industrial- 
type  control  methods  which  are  tailored  to  a  highly  fixtured  environment  where  the 
manipulator  remains  free  from  the  environment.  Examples  are  spot  welding  and 
painting  In  the  few  applications  where  the  task  is  performed  in  contact  with  the 
environment,  the  contact  is  highly  structured  [22].  This  style  of  control  has  limited 
robotics  to  a  narrow  range  of  applications.  In  order  for  robotics  to  have  a  more 
universal  place  in  commercial  and  industrial  applications,  they  must  be  capable  of 
performing  assembly  type  tasks. 

Assembly  is  learned  quickly  and  performed  well  by  the  human  manipulator. 
Goto  et  al  describe  the  human  dextrous  capability  used  during  assembly  tasks  to 
consist  of  three  phases  [18]: 

•  Rough  positioning;  done  by  sight, 

•  Initial  alignment;  done  by  dexterity, 

•  Control  fine  motions  until  complete;  done  by  delicate  touch. 

For  robots  to  perform  assembly  tasks  well,  they  must  be  capable  of  performing  in 
each  of  the  three  categories  of  human  dexterous  motion,  as  seen  in  Figure  2.1. 

Assembly  requires  the  manipulator  to  come  in  contact  with  the  environment 
and  continue  to  function  in  a  controlled  accurate  manner.  This  type  of  interaction 
with  a  traditional  position  controlled  robot,  produces  instability.  Hogan  explains 
that  contact  instability  is  one  of  the  reasons  for  so  little  progress  in  the  area  of 
robotic  dextrous  assembly  [22]. 

With  the  increase  emphasis  on  robotic  assembly,  new  types  of  controllers  have 
emerged  which  can  accommodate  environmental  contact.  Most  notable  are  the  com- 
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Figure  2.1.  Three  Functions  for  Assembly  Tasks  [18] 

pliant  controllers.  Compliance  is  defined  as  the  ability  of  a  manipulator  to  adjust 
to  constraints  [37].  Compliance  can  be  achieved  in  many  ways  which  are  separated 
into  two  general  categories;  active  and  passive  [33].  Passive  compliance  deals  with 
the  flexible  nature  of  the  manipulator  or  the  end  effector.  In  other  words,  passive 
compliance  can  be  designed  into  the  physical  structure  of  the  manipulator  or  end 
effector.  Active  compliance  is  achieved  through  programming  or  controller  design. 
Active  compliance  has  sparked  great  interest  because  a  single  manipulator  can  be 
made  versatile  by  changing  its  compliant  nature  through  software  or  programming 
changes.  In  a  passive  compliance  manipulator,  changing  to  another  task  may  require 
a  physical  restructuring  of  the  manipulator. 

Like  general  industry,  the  Air  Force  is  interested  in  robotic  dextrous  assembly 
and  related  tasks  a s  a  means  to  increase  efficiency  and  replace  some  tasks  currently 
performed  by  humans.  The  purpose  of  this  literature  review  is  to  evaluate  the  current 
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control  schemes  used  in  dextrous  manipulation,  and  how  they  relate  to  on-going 
AFIT  research  efforts.  It  will  focus  on  active  compliant  methods,  and  approaches  to 
simplify  non-linear  effects  such  as  friction  and  contact  dynamics. 

2.2  Compliant  Motion  Survey 

Mason  states  that  “facility  in  compliant  motion  tasks  is  a  prerequisite  to  the  use 
of  manipulators  in  a  number  of  new  applications,  namely  assembly”  [33].  The  need  to 
move  away  from  the  structured  environment  of  the  industrial  robot  is  facilitated  by 
the  use  of  compliant  control  [37],  Active  compliance  has  been  studied  extensively  due 
to  the  flexibility  it  offers  the  user,  i.e.  the  ability  to  program  the  same  manipulator 
to  perform  under  various  conditions.  Active  compliance  can  be  achieved  in  various 
ways.  All  of  these  depend  on  some  form  of  force  control.  Whitney  provides  a  detailed 
explanation  of  the  various  types  of  force  control  [46]  .  A  summary  is  provided  here. 

Figure  2.2  shows  a  block  diagram  of  stiffness  control.  This  type  of  control 
converts  sensed  forces  into  position  adjustments.  This  conversion  is  done  through  a 
stiffness  matrix  which  models  the  total  of  the  environment,  manipulator,  and  sensor 
stiffness.  Essentially  this  type  of  control  models  robotic  environment  interaction  as 
a  spring  mechanism. 

Damping  control  is  similar  to  stiffness  control,  except  in  this  case  the  sensed 
forces  are  converted  into  velocity  adjustments  via  a  damping  matrix.  The  physical 
analogy  for  this  interaction  is  modeling  a  dashpot  or  damper.  See  Figure  2.3  for  the 
block  diagram  of  this  type  of  control. 

In  case  of  explicit  force  control,  the  actual  trajectory  is  described  in  terms  of 
desired  force  instead  of  positions  or  velocities.  Forces  are  sensed  actively  and  are 
compared  to  a  desired  force.  The  difference  between  the  two  forces  serves  as  an  error 
term  to  a  linear  force  control  law  in  this  method.  Figure  2.4  represents  this  type  of 
controller. 
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Figure  2.2.  Stiffness  Control  [46] 


Figure  2.3.  Damping  Control  [46] 


Implicit  force  requires  no  force  sensor.  Displacements  of  the  end  effector  and 
environment  are  converted  to  forces  through  a  conversion  or  stiffness  matrix.  Fig¬ 
ure  2.5  shows  that  in  reality  implicit  force  control  is  another  form  of  position  control. 
Finally,  the  individual  joint  gains  are  adjusted  in  order  to  obtain  various  manipulator 
stiffnesses. 

Within  hybrid  control,  position  and  force  are  controlled  separately  under  the 
same  control  structure.  First,  the  task  is  divided  into  constrained(contact)  and 
unconstrained  axes.  Force  is  controlled  in  the  constrained  axes,  while  position  is 
controlled  in  the  unconstrained  direction.  This  combination  allows  for  high  position 
tracking  in  the  free  space  axes  while  simultaneously  accommodating  constraints  in 
the  other  axes.  The  combination  of  these  essentially  independent  controllers  is  made 
through  a  ‘selection  matrix’.  The  selection  matrix  is  a  diagonal  n  by  n  matrix  with 
either  one’s  of  zero’s  on  the  diagonal.  A  T’  turns  force  control  on  and  position 
control  off  in  the  corresponding  axis.  A  typical  hybrid  controller  is  represented  in 
Figure  2.6 

Figure  2.7  portrays  an  impedance  control  scheme.  Defined  as  a  generalized  sum¬ 
mation  of  the  stiffness  and  damping  controllers,  the  impedance  controller  is  similar 
to  the  hybrid  in  the  sense  that  it  combines  the  nature  of  two  types  of  controllers. 
It  differs  in  the  way  the  combination  is  made.  The  key  difference  is  that  hybrid 
control  functions  on  an  either/or  basis.  That  is,  either  force  or  position  is  controlled 
in  a  specific  axis.  Impedance  control,  on  the  other  hand,  regulates  impedance  which 
is  a  combination  of  force,  position,  and  velocity  terms.  Note,  that  both  stiffness 
and  damping  control  can  be  considered  subsets  of  impedance  control.  The  major 
difference  is  that  in  the  full  impedance  controller,  both  desired  position  and  velocity 
trajectories  are  provided  as  inputs.  In  stiffness  control  only  desired  position  is  stated, 
and  in  damping  its  desired  velocity. 

In  summary,  Hogan  identifies  one  key  issue  in  dextrous  manipulation  as  the 
ability  to  deal  with  contact  instabilities.  His  evaluation  of  the  various  types  of  force 
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Figure  2.5.  Imlicit  Force  Control  [46] 
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S  -  Diagonal  matrix  ot  ones  and  zeroes 
I  -  Identity  matrix 


Figure  2.6.  Hybrid  Control  [46] 


Figure  2.7.  Impedance  Control  [46] 


Figure  2.8.  Stiffness  Controlled  Sprinkler  Assembly  [38] 


control  identifies  that  only  impedance  control  integrates  the  effects  of  the  combined  or 
dynamic  relationship  between  force  and  motion.  In  other  words,  we  “must  recognize 
that  dynamic  interactions  are  an  integral  part  of  the  task”  [22].  Its  important  to  note 
that  assembly  tasks  can  be  performed  with  any  of  the  compliant  control  methods. 
Salisbury  [38]  used  a  stiffness  controller  to  demonstrate  the  assembly  of  a  lawn 
sprinkler  assembly  which  is  shown  in  Figure  2.8.  However,  in  this  example  there 
was  a  degree  of  fixturing  required  to  provide  gross  relative  alignments  of  the  mating 
parts. 

The  hybrid  controller  is  structured  in  the  sense  that  the  selection  matrix  must 
be  generated.  This  generation  requires  evaluation  of  the  task  being  performed  to 
determine  which  axes  control  force  and  position.  The  current  focus  on  impedance 
control  derives  from  its  flexibility.  Impedance  contiol  does  not  require  exact  knowl¬ 
edge  of  position  or  force  to  perform  compliant  tasks.  In  addition,  this  type  of  control 
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can  be  used  in  freespace.  Hogan  claims  “the  distinguishing  feature  and  advantage 
of  impedance  control  is  that  the  same  controller  used  to  deal  with  free  motions  can 
also  be  used  with  real  mechanical  interactions” [21].  Stated  another  way,  impedance 
control  is  the  most  human-like  of  the  control  schemes.  Thus  impedance  control  is 
an  ideal  candidate  to  perform  constrained  assembly  tasks.  The  remainder  of  this 
chapter  will  focus  specifically  on  impedance  control. 

2.3  Impedance  Control 

2.3.  1  Theory  Hogan  develops  impedance  control  using  bond  graph  formalisms. 
Impedance  and  admittance  are  defined  within  that  formalism  as  two  types  of  phys¬ 
ical  system  behavior.  Impedances  are  described  as  elements  “which  accept  flow 
(e.g., motion)  inputs  and  yield  effort  (e.g., force).”  Admittances  are  the  inverse,  that 
is,  elements  “which  accept  effort  (e.g., force)  inputs  and  yields  flew  (e.g., motion).”  A 
physical  example  of  impedance  and  admittance  is  a  spring  and  mass,  respectively. 

Admittance  and  impedance  are  common  concepts  in  linear  electrical  theory 
[19].  In  that  context  the  two  concepts  are  essentially  reciprocals  of  each  other.  How¬ 
ever,  in  manipulation  tasks  they  are  generally  non-linear,  non  reciprocal  in  nature. 
Basically,  Hogan’s  formalization  determines  that  certain  physical  elements  are  in¬ 
herently  admittances  or  impedances.  The  foregoing  descriptions  are  important  in 
impedance  control  development  because  the  nature  of  interaction  between  elements 
is  determined  by  their  inherent  behavior.  “The  most  important  consequence  of  dy¬ 
namic  interaction  between  two  physical  systems  is  that  one  must  compliment  the 
other"(l9].  Therefore,  when  two  systems  interact  they  must  be  compliments;  if  one 
is  an  admittance  the  other  must  be  an  impedance.  This  is  similar  to  the  impedance 
matching  necessary  between  an  amplifier  and  a  speaker. 

Masses  are  inherently  admittances.  Constrained  robotic  tasks  create  the  situ¬ 
ation  in  which  two  masses  interface;  the  robot  and  the  environment.  As  previously 
stated,  for  physical  systems  to  interact  in  a  stable  manner  they  must  be  compliments 
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Figure  2.9.  RCC  Graphical  Example  [25] 


i.e.,  if  one  interacting  element  is  an  admittance,  the  other  must  be  or  perform  like 
an  impedance.  To  achieve  this,  there  are  three  options:  cause  the  environment  to 
emulate  an  impedance;  add  a  third  impedance  element  at  the  interface  or;  cause  the 
manipulator  to  emulate  an  impedance.  Generally  speaking,  the  environment  is  not 
easily  modified  to  emulate  an  impedance.  This  shifts  the  focus  to  one  of  the  other 
two  options.  Introducing  a  third  interfacing  element  with  impedance  characteris¬ 
tics  is  one  motivation  for  passive  compliant  devices  such  as  the  Remote  Center  of 
Compliance  shown  in  Figure  2.9,  or  the  soft  sensor. 

However,  these  methods  have  limited  applications  and  performance  regions  [19]. 
The  final  choice  is  to  require  the  manipulator  to  emulate  an  impedance.  Due  to  the 
programmable  nature  of  robotic  controllers,  this  option  is  given  the  designation  of 
impedance  controller  [19]. 

The  foundation  for  Hogan’s  approach  to  impedance  control  is  to  model  the 
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manipulator  as  a  second  order  spring-mass-damper  system.  Such  a  modeling  provides 
all  the  essential  elements  necessary  to  emulate  a  wide  range  of  impedance  values.  The 
spring  portion  provides  necessary  position/tracking  control.  The  damper  provides 
damping  through  velocity  terms.  Finally,  the  mass  provides  the  essential  capability 
to  modulate  force  terms  [21]. 

2.3.2  Controller  Implementation  Hogan’s  analysis  of  impedance  control  re¬ 
sulted  in  the  following  general  control  law  [20]: 

Tad  =  I{q)J-xM~'K[x o  -  L(q)]  +  S(q) 

+I(q)J-'M-1B[v0-  Jq)  +  V(q) 

-[Jr  +  nq)J"1M-l]Fini 

-I{q)J-lG{q,q)  +  C{q,q)  (2.1) 

The  control  law  subsequently  implemented  by  Duvall  [14]  was 

Tact  =  I{q)J-lM~lI< [x0  -  L(q)}  +  S(q) 

- I(q)J-'M~'BJq+V(q ) 

-[JT  +  I{q)J-'M~'}Fint  (2.2) 

Finally,  the  control  law  implemented  by  Milholen  [34]  was 

Tact  =  I{q)J~1M~1K[x0  -  L(q)}  -(-  S{q) 

+ I{q)J-'M-lB[vo-  Jq]  +  V(q) 

-[JT  +  /(9)J-1M-1]Fnt  (2.3) 


where: 

q  is  the  measured  joint  position 
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q  is  the  computed  joint  velocities 
I  is  the  manipulator  inertia  matrix 
J-1  is  the  inverse  jacobian  matrix 
M -1  is  the  inverse  desired  mass  matrix 
K  is  the  desired  stiffness  matrix 
£o  is  the  commanded  position 
L  is  the  position  from  forward  kinematics 
S  is  the  gravity  compensation  term 
B  is  the  desired  damping  matrix 
i?o  is  the  commanded  velocity 
V  is  the  friction  compensation 
JT  is  the  jacobian  transpose 

Fint  is  the  interface  force  between  constraint  and  manipulator 
G  and  C  are  coriolis  and  centripetal  terms 

Equations  2.1,  2.2  and  2.3  are  divided  into  position  dependent  terms  on  the  first 
line,  velocity  dependent  terms  on  the  second  line,  and  force  related  terms  on  the 
third  line.  Duvall’s  implementation  of  Hogan’s  law  assumes  that  the  non- linear 
terms,  Coriolis  and  centripetal,  are  approximately  zero.  Duvall  also  assumed  that 
the  commanded  velocity  was  zero.  Milholen’s  version  of  Equation  2.1  implements  a 
non-zero  commanded  velocity  term.  The  control  law  implemented  in  this  effort  was 
a  three  by  thr^e  matrix  version  of  Equation  2.3. 

2.4  Issues  in  Impedance  Control 

The  ability  to  perform  constrained  motion  makes  impedance  control  widely 
studied.  At  the  same  time,  constrained  motion  is  a  source  of  some  difficult  problems. 
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Stability  is  a  concern  whenever  force  sensors  are  included  in  a  system  [36,  47]  and 
the  influence  of  unmodeled,  non-linear  effects  such  as  friction  and  other  mechanical 
joint  interactions  are  difficult  to  model  and  compensate. 

2. 4- 1  Stability  Sharon  and  others  [39]  defined  a  technique  termed  physical 
equivalence  which  originates  from  Hogan’s  discussion  on  impedance  control.  Phys¬ 
ical  equivalence  states  that  a  controlled  physical  system  can  be  made  equivalent  to 
another  uncontrolled  physical  system  [19].  Based  on  physical  equivalence,  Sharon  et 
al.  propose  that  to  obtain  stability  in  a  controlled  physical  system,  merely  require 
that  the  target  system  emulate  another  known  stable  system.  The  example  they  use 
is  a  stable  spring-mass-damper  configuration.  Therefore,  if  a  manipulator  is  modeled 
and  controlled  to  emulate  a  spring-mass-damper,  it  will  be  stable  as  well.  This  is  the 
same  reasoning  used  by  Hogan  to  develop  the  impedance  control  law.  Hogan  [19] 
and  others  [3]  discuss  that  the  mass  term  is  the  key  to  determining  contact  stability. 
Thus  the  spring  and  damper  terms  provide  for  minimum  error  tracking,  while  the 
mass  term  governs  contact  stability. 

2.4 - 2  Non-Linear  Effects  Perhaps  the  limiting  factor  in  the  pnysical  equiva¬ 
lence  method,  is  controlling  the  system  such  that  it  truly  behaves  like  the  desired 
model.  The  realities  of  phenomena  such  as  friction,  gear  backlash,  and  non-linear 
dynamics  may  severely  limit  how  well  the  controller  causes  the  system  to  emulate 
the  desired  behavior.  Salisbury  noted  that  coulomb  friction  in  manipulator  joints  is 
the  most  severe  non-linearity  involved  in  manipulation  [38]  .  A  separate  discussion 
of  friction,  including  coulomb,  follows  the  discussions  on  backlash  and  dynamics. 

2.4-2. 1  Backlash  Tustin  described  backlash  as  the  effect  caused  while 
“the  displacement  of  one  mechanical  part  produces  equal  displacement  in  another 
mechanical  part,  but  only  after  taking  up  a  definite  clearance  in  the  direction  of 
drive”  [44].  Tustin  further  stated  that  backlash  has  little  effect  on  a  system  when 
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displacements  are  much  greater  than  the  backlash  magnitude.  However,  when  dis¬ 
placements  are  not  much  iarger  than  backlash  magnitude,  the  result  can  be  a  phase 
lag  of  90  degrees  or  greater.  This  phase  lag  can  contribute  to  instabilities  [44].  When 
the  axis  of  rotation  for  a  joint  is  perpendicular  to  the  gravity  field  the  backlash  ef¬ 
fects  are  dramatically  reduced  or  eliminated  [27].  This  is  demonstrated  in  the  large 
joints  of  the  PUMA  560  manipulator.  The  axis  of  rotation  for  Joint  one  is  co-linear 
with  the  gravity  field,  while  the  axes  of  rotation  for  joints  two  and  three  are  per¬ 
pendicular  to  that  field.  Ahmad  notes  that  backlash  is  generally  prominent  only  in 
joint  one  of  the  PUMA  560  [l].  One  approach  used  to  eliminate  backlash  effects  is 
to  employ  direct-drive  methods.  Another  is  to  design  anti-backlash  mechanisms  into 
the  manipulator.  This  type  of  anti-backlash  technique  is  functional  on  the  particular 
PUMA  used  in  this  research. 

2. 4-2. 2  Dynamics:  Coriolis  and  Centripetal  These  dynamics  are  nonlin¬ 
ear  terms  that  are  velocity  and  position  dependent.  The  coupling  effects  of  Coriolis 
and  centripetal  terms  are  more  pronounced  as  velocity  increases.  To  minimize  de¬ 
sign  complexity,  these  terms  are  often  either  ignored  or  linearized.  Leahy  et.  al 
have  shown  that  feedforward  and  other  model-based  dynamic  compensation  tech¬ 
niques  which  include  these  terms  can  greatly  improve  tracking  performance  [28,  30]. 
In  some  cases,  if  velocity  is  small,  the  Coriolis  and  centripetal  terms  can  be  ignored 
with  good  results.  Duvall  [14]  and  Milholen  [34]  use  this  approach  in  their  evaluation 
because  constrained  tasks  are  generally  performed  at  slow  speeds. 

2  5  Friction 

Friction  is  an  element  in  nearly  all  mechanical  systems  [8, 13] ,  yet  it  is  extremely 
difficult  to  model  owing  to  its  discontinuous  and  non-linear  nature  [13,  4,  17,  43]. 
One  of  the  complicated  aspects  of  friction  is  that  it  is  manifest  at  various  levels, 
from  lubricant  effects  [5]  to  material  deformations  [5,  45].  Of  all  the  various  ways 
to  categorize  frictional  effects,  the  most  common  are  coulomb,  stiction,  and  viscous. 
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Many  research  efforts  have  identified  friction  as  the  cause  or  a  major  contributor  to 
undesirable  performance  such  as  limit  cycles  and  stick-slip  motion  [10,  43,  44,  5, 13]. 
The  remainder  of  this  section  will  evaluate  the  effects  of  the  various  categories  of 
friction  on  system  performance. 

2.5.1  Coulomb  Friction  is  defined  as  a  “dissipative  force  that  appears  at  the 
contact  surface  of  two  bodies  in  relative  motion”  [17].  This  type  of  friction  results 
in  a  force  that  always  opposes  the  direction  of  motion.  Compensating  for  coulomb 
friction  can  require  up  to  25  percent  of  total  motor  torque  [17].  Instead  of  a  singular 
quantity,  coulomb  friction  is  a  summary  description  of  many  complicated  interactions 
that  occur  at  a  lower  level  [17,  9,  45].  This  is  perhaps  the  central  reason  that 
compensating  for  friction  effects  is  difficult  [10,  13].  Another  contributing  factor  to 
the  complexity  of  coulomb  friction  is  the  discontinuity  at  zero  velocity  [43]. 

2.5.2  Static  Friction  Static  friction  deals  with  bodies  at  rest.  When  an  exter¬ 
nal  force  is  applied  to  a  body  at  rest,  static  friction  will  produce  a  nullifying  counter 
force  in  order  to  keep  the  body  at  rest.  This  force  continues  until  the  external  force 
reaches  a  threshold  above  which  motion  occurs.  Similar  to  coulomb  friction,  static 
is  discontinuous  at  zero  velocity  [43].  Often,  this  type  of  friction  is  combined  with 
stiction  [43,  13]. 

2.5.3  Stiction  Stiction  is  defined  as  that  portion  of  static  friction  force  which 
is  greater  than  the  magnitude  of  coulomb  friction  force  [10,  8,  45].  Associated  with 
stiction  is  a  concept  called  break-away.  Break-away  force  is  the  point  at  which  static 
friction  forces  can  no  longer  oppose  the  applied  forces,  allowing  for  object  motion 
[9,  43] 

2.5.4  Viscous  Friction  Viscous  friction  is  associated  with  the  viscous  nature 
of  lubricants  used  in  machine  parts  [5].  Generally,  this  effect  increases  linearly  with 
increases  in  velocity. 
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2.5.5  Effects  of  Friction  Friction  is  present  to  some  degree  in  all  mechanical 
systems.  In  evaluating  the  literature,  a  common  theme  emerges:  Inexact  friction 
compensation  cam  degrade  performance.  For  example,  overcompensation  of  coulomb 
friction  can  lead  to  unstable  limit  cycles  [10,  9].  Another  result  of  inexact  compensa¬ 
tion  is  phase  shifts  that  can  actually  amplify  rather  than  reduce  the  negative  elfects 
of  friction  [44,  43]. 

Predominance  of  one  type  of  friction  over  another  depends  largely  on  the  ve¬ 
locity  involved.  Research  shows  that  at  low  velocities,  coulomb  and  static  friction 
dominate  due  to  the  non-linear,  discontinuous  nature  in  that  range  [5, 13,  43,  44, 16]. 
Currently,  many  of  the  force  control  tasks  are  accomplished  in  this  low  velocity  range 
[24,  18,  43,  34,  14].  As  a  result,  there  is  a  heavy  emphasis  on  ways  to  reduce  or  elim¬ 
inate  coulomb  and  static  friction  effects. 

2.6  Friction  Compensation 

There  are  various  methods  used  to  minimize  or  zero  the  effects  of  friction  on 
a.  system.  The  major  contributions  to  compensation  techniques  are  modeling  and 
adaptation.  This  section  will  review  the  current  efforts  using  these  tools  to  reduce 
or  eliminate  friction  influence. 

For  any  given  system,  the  level  of  performance  will  dictate  the  fidelity  of  the 
model  used  to  represent  that  system.  Generally,  “  due  to  the  complexity  of  friction 
models  in  individual  components,  robotics  researchers  typically  consider  an  aggregate 
friction  model  for  each  robot  joint”  [13].  If  implemented  correctly,  modeling  serves 
to  linearize,  reduce,  or  eliminate  frictional  effects.  Feedforward  terms  such  as  those 
in  model-based  control  [31]  axe  one  example  of  how  modeling  can  linearize  non¬ 
linear  effects  [8].  Obviously,  the  more  accurate  the  model,  the  more  nullifying  the 
compensation  [45].  Unfortunately,  exact  models  are  not  feasible  nor  available,  due 
to  the  complex  nature  of  friction  in  physical  systems.  The  most  common  form  of 
friction  models  are  variants  of  an  aggregate  coulomb  and  stiction  model.  Some 
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Figure  2.10.  Composite  Friction  Model  [34] 

friction  models  are  piece-wise  linear  combinations  of  coulomb  and  stiction,  while 
others  include  the  effects  of  Tustin’s  [44]  exponential  decay  to  transition  between 
static  and  coulomb  terms  [8].  Still  other  models  combine  viscous  friction  with  one 
or  more  of  the  above  mentioned  models  [34,  29,  13].  Figure  2.10  shows  the  model 
used  by  Milholen  [34]. 

One  technique  used  to  avoid  overcompensation  is  to  establish  maximum  values 
needed  to  fully  compensate  for  a  particular  term.  Once  the  maximum  is  established, 
the  actual  compensation  term  is  set  at  a  value  less  than  the  maximum.  In  this 
way,  unstable  limit  cycles  resulting  from  coulomb  overcompensation  can  be  avoided 
[29, 34],  Adaption  techniques  have  been  given  more  attention  as  methods  to  deal  with 
inexact  modeling.  Many  researchers  working  on  friction  models  have  concluded  that 
adaptive  techniques  offer  the  greatest  general  method  to  reduce  or  nearly  eliminate 
the  effects  of  friction  [8,  9,  10,  4, 16,  42].  Adaption  techniques  are  treated  only  briefly 
in  this  effort.  They  appear  to  be  a  logical  next-step  area  for  future  research  following 
the  successful  implementation  of  the  three  DOF  control  scheme  with  a  traditional 
friction  model. 
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2. 7  Summary 

This  chapter  has  reviewed  the  motivation  for  using  compliant  motion  force  con¬ 
trol  to  develop  robotic  refueling.  The  use  of  impedance  control  by  Duvall  [14]  and 
Milholen  [34]  has  shown  that  this  type  of  force  control  is  well  suited  for  the  peg-in- 
the-hole  assembly  task  represented  by  aircraft  refueling.  Refueling,  and  other  slow 
velocity  assembly  tasks  introduce  problems  such  as  the  dominance  of  frictional  ef¬ 
fects.  Combining  the  inherently  unstable  aspect  of  force  control  with  slow  velocities, 
creates  the  need  for  methods  to  counter  these  effects.  The  literature  revealed  that 
modification  of  the  mass  term  in  the  impedance  controller  can  eliminate  the  unstable 
force  control.  Friction  effects  can  be  reduced  through  appropriate  modeling  and/or 
combined  with  the  emerging  adaptive  approaches.  The  next  chapter  will  examine 
the  implementation  of  these  ideas  in  aircraft  refueling. 
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III.  Tools  and  Implementation  of  Impedance  Control 


3.1  Overview 

This  effort  is  an  expansion  and  clarification  of  the  work  done  by  Milholen  [34], 
In  order  to  fully  understand  the  results,  its  necessary  to  describe  the  test  environment 
used  to  create  the  data.  Most  of  the  equipment  and  theory  used  to  create  the  three 
degree  of  freedom  impedance  controlled  robotic  refueler  remains  unchanged  from 
that  used  by  Duvall  [14]  and  Milholen  [34].  This  chapter  will  describe  the  following 
aspects  of  the  test  environment:  haidware,  system  support  software  and,  control 
algorithm. 

3.2  Hardware 

The  hardware  used  is  separated  into  functional  categories  defined  by  the  AFIT 
Hierarchical  Control  System  (AHCS)  implemented  by  Duvall  and  enhanced  by  Mil¬ 
holen.  The  central  concept  behind  this  system  is  to  utilize  hardware  at  levels  best 
suited  for  specific  tasks.  This  system  is  divided  into  three  levels:  organizer,  coordina¬ 
tor,  and  hardware.  Duvall  [14:4-17]  and  Milholen  [34:3-7]  provide  a  more  complete 
description  of  the  various  levels.  Figure  3.1  provides  a  graphical  portrayal  of  the 
AHCS,  with  a  description  to  follow. 

3.2.1  Organizer  The  organizer  level  facilitates  user  interface,  handles  com¬ 
munication  protocols  with  the  coordinator,  provides  the  capability  to  execute  large 
off-line  calculations,  and  maintains  safety  functions  for  the  system.  Currently,  AHCS 
accesses  one  of  two  available  VAXstation  III  computers  for  use  at  the  organizer  level. 

3.2.2  Coordinator  This  level  is  the  key  portion  of  the  AHCS.  It  provides  the 
link  between  the  organizer  and  hardware  levels.  This  includes  communicating  with 
the  manipulator  and  the  force  sensor.  Milholen  [34:3-7]  states  that  this  level  is  used 
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Figure  3.1.  Hierarchial  Control  System  [34].  Robbie  and  Cyclop  are  both  VAXS- 
tation  Ills. 

to  collect  and  partially  process  data  from  the  manipulator  and  force  sensor  and 
control  communication  tasks.  The  hardware  at  this  level  is  the  PUMA  LSI-11/73 
along  with  RAM,  and  various  communication  devices  connected  through  a  Q-bus. 

S.2.S  Experimental  Hardware  The  target  of  the  AHCS  operating  hardware  is 
at  this  level.  Here  is  where  the  manipulator  and  the  force  sensor  electronics  reside. 
These  provide  the  means  to  perform  the  desired  experimentation. 
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Figure  3.2.  PUMA-560  Manipulator  with  DH  Coordinate  Frames  [15] 


3.2.8. 1  Manipulator  The  manipulator  used  was  a  PUMA  560.  This 
robot  is  an  industrial-type  six  degree  of  freedom  vertically  articulated  manipula¬ 
tor.  It  provides  a  good  framework  for  evaluating  various  performance  character¬ 
istics.  Figure  3.2  represents  the  PUMA  560  manipulator  along  with  the  Dtnavit- 
Hartenburg(DH)  coordinate  frames.  The  manipulator  derives  three  DOF  from  the 
three  heavy  links.  The  remaining  three  DOF  are  contained  in  the  roll-bend-roll  wrist. 
This  research  applied  the  compliant  controller  to  the  degrees  of  freedom  associated 
with  the  three  heavy  links  of  the  PUMA.  The  wrist  was  commanded  by  a  traditional 
PD  control  law  that  forced  the  wrist  to  remain  rigid. 


3. 2.3.2  Force  Sensor  The  force  sensor  provides  for  six  axis  force  moni¬ 
toring.  This  particular  force  sensor  was  manufactured  by  JR3  Incorporated.  The 
sensor  package  includes  the  transducer,  support  electronics,  and  power  supply.  Fig¬ 
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ure  3.1  shows  the  integration  of  the  sensor  package  into  the  test  environment.  The 
transducer  shown  in  Figure  3.3  consists  of 

two  parallel  plates  connected  by  four  octagonal  ‘bridges’.  The  plates  are 
bolted  separately  to  the  PUMA  and  the  tool,  so  all  load  must  pass  through 
the  bridges.  Foil  strain  gages  are  mounted  on  the  sides  of  the  octagons, 
and  resistance  changes  in  the  strain  gauges  are  measured  and  interpreted 
as  forces  or  moments  using  a  calibration  matrix  unique  to  each  transducer 
[14:4-8]. 


In  figure  3.3,  the  bridges  are  represented  by  numbers  15,  16,  22,  and  25.  The 
strain  gages  are  the  checkered  patterns  shown  on  the  bridges.  The  transducer  is 
attached  to  the  tool  mounting  plate  on  the  PUMA  joint  six.  The  support  electronics 
are  housed  separately  from  any  other  hardware.  The  electronics  are  divided  into  two 
pieces:  the  power  supply,  and  active  electronics.  The  active  electronics  provide  the 
sensor  operating  system.  This  operating  system  allows  for  calibration,  and  system 
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diagnostic  checks,  and  communication  with  other  systems.  For  this  research,  all 
real-time  data  transfer  occurs  via  a  DRV-11  parallel  interface.  Sensor  calibrations 
and  bias  removal  are  accounted  for  in  the  FARCADE  program  software. 

3.2.S.3  Refueling  Port  To  demonstrate  refueling  type  tasks,  a  half-scale 
model  of  a  standard  UARRSI  wa s  designed  by  Duvall  and  fabricated  in  the  AFIT 
model  shop  [14].  The  mockup  consists  of  two  major  parts:  the  slipway,  and  the 
refueling  boom  nozzle.  The  slipway  is  an  approximate  representation  of  an  actual 
slipway.  In  a  UARRSI  slipway  there  is  a  smooth  transition  from  the  open  slope  to 
the  receiver.  Duvall  chose  to  make  the  fabrication  easier  by  making  the  transition 
a  squared  corner.  This  modification  does  not  affect  the  ability  to  simulate  compli¬ 
ant  refueling  tasks.  It  does  create  a  test  environment  which  presents  a  more  severe 
obstacle  to  surmount.  In  actuality,  this  design  provides  a  means  to  test  compliance 
techniques  at  extreme  path  discontinuities.  Attached  to  the  force  sensor  transducer, 
the  nozzle  consists  of  three  parts  that  are  threaded  together:  the  mounting  plate, 
the  shaft,  and  the  nozzle  end.  The  nozzle  portion  is  only  representative  of  an  actual 
nozzle  in  the  diametral  dimensions.  Capt  Duvall  essentially  fabricated  a  ‘soup  can’ 
which  threads  onto  the  end  of  the  shaft.  As  with  the  port,  this  simplifying  change  in 
no  way  diminishes  the  ability  to  examine  compliant  tasks.  This  experiment  made  one 
slight  modification  to  Duvall’s  nozzle  design.  Duvall  used  a  three  portion  threaded 
shaft  to  facilitate  various  applied  moments  by  changing  the  shaft  length.  This  appli¬ 
cation  was  never  used  however  due  to  clearance  problems  between  the  PUMA  and 
the  slipway  The  threaded  shaft  failed  under  heavy  test  loads.  Therefore,  a  solid  shaft 
of  like  specifications  was  fabricated  for  this  thesis. 

3. 3  System  Support  Software 

The  software  used  in  this  thesis  is  based  on  the  previously  mentioned  hierar¬ 
chical  concepts.  At  the  AFIT  robotics  lab,  a  general  test  environment  is  used  to 
evaluate  various  control  laws.  To  facilitate  this  general  nature,  a  software  environ- 
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ment  was  created  by  previous  researchers.  This  environment  is  termed  the  AFIT 
Robotic  Control  Algorithm  Development  Environment  (ARCADE)  [32,  26,  14,  34], 
ARCADE  is  the  software  side  to  the  AHCS.  Here  programming  languages  are  used 
where  most  appropriate,  i.  e.  the  high  level  language  FORTRAN  is  used  at  the  or¬ 
ganizer  level  on  the  VAXstations.  At  the  coordinator  level,  PDF  assembly  language 
is  used  for  speed  and  compactness.  ARCADE  also  provides  ability  to  access  various 
control  schemes  and  apply  them  to  different  manipulators.  FARCADE,  a  deriva¬ 
tive  ARCADE,  was  created  by  Capt  Duvall  [14]  and  subsequently  modified  by  Capt 
Milholen  [34].  The  ‘F’  represents  ‘force’. 

Capt  Duvall  had  limited  computer  resources  available  and  was  restricted  to 
implement  extensive  assembly  language  code  at  the  coordinator  level  [14]  With 
more  abundant  computer  resources,  Capt  Milholen  reorganized  much  of  the  t ask¬ 
ings.  Much  of  the  assembly  code  at  the  coordinator  level  was  re-hosted  in  VMS 
FORTRAN  and  applied  at  the  organizer  level.  Milholen ’s  effort  allowed  for  only  es¬ 
sential  functions  at  the  coordinator,  and  provided  a  better  user  interface  by  moving 
much  of  the  tasks  to  the  organizer.  No  structural  changes  were  made  to  Milholen’s 
FARCADE  during  this  effort. 

5.5.1  FORTRAN  Support  There  are  many  support  sub-programs  called  by 
FARCADE.  They  vary  from  loading  data  files  containing  PUMA  and  force  sensor 
constants,  to  creating  actual  cartesian  trajectory  files,  and  data  handling  options 
like  graphing  and  storage. 

5.5.2  Assembly  Language  Support  There  are  a  number  of  PDP-11  assembly 
code  programs  that  support  the  FARCADE  environment.  The  most  important  one 
is  the  Servo  Data  Concentrator  ANGLES  and  FORCE  (SDCAAF).  It  provides  the 
vital  link  between  the  PUMA  and  the  user  by  collecting  and  shuttling  joint  angles, 
motor  currents,  and  forces  from  the  force  sensor  between  the  hardware  and  organizer 
level.  The  assembly  sub-program  that  actually  interfaces  with  the  force  sensor  is 
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called  GETRFV.  Some  of  the  key  FORTRAN  sub-programs  will  be  discussed  in  the 
Section  3.5. 

3.4  Control  Algorithm  Development 

The  control  law  use  in  FARCADE  is  based  on  Hogan’s  impedance  control  law. 
As  stated  in  chapter  two,  impedance  control  causes  the  manipulator  to  behave  like 
an  impedance.  This  impedance  controller  models  the  manipulator  as  a  spring-mass- 
damper.  The  exact  values  are  arbitrary  so  long  as  certain  ratios  of  these  terms  are 
maintained.  This  modeling  is  referred  to  as  the  “desired  dynamics”  model  by  Hogan 
[19,  34].  The  development  of  this  control  law  is  presented  next. 

3-4-1  Impedance  Controller  This  subsection  presents  a  condensed  version  of 
the  development  done  by  Duvall  [14:p  3-6,  appendix  A]  and  modified  by  Milholen 
[34:p  3-16],  Figure  3.4  displays  a  block  diagram  of  the  controller  described  below  . 

Beginning  with  the  desired  dynamics  concept,  the  mathematical  representation 
is  found  in  Equation  3.1  where  ‘x’  and  V  represent  cartesian  position  and  velocity 
respectively,  and  the  subscripts  ‘a’  and  ‘d’  represent  actual  and  desired  values. 

Fint  =  K(xd  -  xa)  -f  B(vd  -  va)  +  M ~~  (3.1) 

This  is  a  matrix  equation  which  can  be  implemented  up  the  number  of  DOF  of  the 
manipulator  involved;  six  for  the  PUMA.  Because  the  M,  B ,  and  K  matrices  are  each 
diagonal,  these  equations  can  be  analyze  as  decoupled  linear  second  order  equations. 
Duvall  and  Milholen  implemented  only  two  DOF  involving  joints  two  and  three. 
These  equate  to  the  world  x-z  coordinate  plane.  One  of  the  major  contributions 
of  this  thesis  was  to  upgrade  the  controller  to  three  DOF,  which  is  general  enough 
to  demonstrate  robotic  refueling  for  a  wide  class  of  applications.  Noting  that  the 
difference  terms  in  Equation  3.1  are  simply  error  terms  of  the  form  of  Equation  3.2 
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Figure  3.4.  Control  System  in  Block  Diagram  Form.  [34] 
where  ‘a’  represents  cartesian  acceleration, 

C  —  Xrf  Xq 

e  =  Vd  —  va 

e  =  ad  —  aa  (3.2) 

Equation  3.1  can  be  re-written  as: 

JFint  —  Ke-\-  Be  +  Me  (3-3) 
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Applying  a  Laplace  transform  to  Equation  3.3  we  obtain  the  the  following  transfer 
function: 

E(s)  _  1 

flnl(a)  +  §  S  +  £ 

Equating  the  characteristic  polynomial  from  Equation 
equation  for  a  second  order  system, 


(3.4) 

3.4  with  the  characteristic 


s2  +  2(ujns  +  u }2 


S 2  + 


K_ 

M 


We  obtain  the  following  relationships: 

B_ 

M 
if 

M 


(3.5) 


(3.6) 


From  pole  placement  techniques  [11]  the  two  closed-loop  poles  are  the  following: 


s  =  -±u^±juny/l-(*  (3.7) 

1  S  2 

where  underbrace  ‘1’  represents  a  and  underbrace  ‘2’  represents  tOd-  The  exact 
values  for  B,  K,  and  M  are  specified  such  that  the  relationships  to  (,  u>d,  and  un  are 
maintained.  Like  Duvall  [14]  and  Milholen  [34],  £  was  initially  chosen  to  be  greater 
than  one  to  facilitate  over-damping.  The  choice  for  un  is  determined  based  on  other 
techniques  that  will  be  discussed  in  Chapter  Four.  By  specifying  (,  and  the  bounds 
are  set  for  the  choices  of  desired  mass  (M),  damping  (D),  and  spring  constant  or  gain 
(K).  Within  these  bounds  the  specific  values  can  be  adjusted  to  meet  the  particular 
contact  scenario  encountered.  This  provides  a  simple  method  for  tuning  based  on 
different  impedance/admittance  values  encountered  at  the  manipulator  interface. 

To  fully  implement  the  control  law  it’s  necessary  to  include  other  terms  that 
allow  for  complete  controller  function  in  cartesian  space.  These  terms  account  for 
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the  physical  nature  of  any  manipulator:  inertia  due  to  the  mass,  gravity  and  friction, 
and  the  kinematic  relationship  of  all  points  in  the  manipulator.  The  following  sub¬ 
sections  detail  these  items. 

3.4-2  Dynamics  Reference  [I5:p  84-98]  provides  an  in-depth  discussion  of  dy¬ 
namic  terms.  A  brief  summary  of  that  work  is  provided  here.  By  applying  energy 
equations  of  the  Lagrange  Euler  formulation  to  a  robot  manipulator,  the  generic 
equation  of  motion  reduces  to  the  matrix  equation  [15]: 

r(t)  =  i  (q(O)q(O  +  H  (q(0»  q(*))  +  c  (q(0)  (3-8) 

The  term  r  represents  the  joint  torque  vector.  The  terms  q,  q,  and  q  represent  the 
joint  angles,  velocities,  and  accelerations  vectors  respectively.  The  inertia  matrix 
is  represented  by  1.  Coriolis  and  centrifugal  terms  are  represented  by  H.  C  is  the 
matrix  of  gravity  related  terms.  As  stated  in  Chapter  2,  the  Coriolis  and  centrifugal 
terms  are  assumed  negligible  for  this  case,  and  are  not  considered  further. 

3. 4-2.1  Inertia  Tensor  The  inertia  tensor  represents  the  mass  and  re¬ 
flected  mass  effects  on  each  actuator.  Because  mass  is  representative  of  acceleration 
terms,  the  inertia  tensor  represents  the  interrelated  accelerations  of  one  link  on  the 
others  [15:p  93-96].  For  the  full  six  BOF  manipulator,  the  inertia  tensor  is  six-by- 
six.  However,  impedance  control  will  be  only  applied  to  the  first  three  joints  for 
this  thesis.  Hence,  the  inertia  tensor  of  concern  will  be  the  upper  left  three-by-three 


sub-tensor  identified  in  Equation  3.9. 
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Inertia  tensor  values  are  calculated  by  combining  the  Denavit-Hartenburg  parameters 
for  the  PUMA  560  [15]  with  the  symbolic  inertia  equations  worked  out  by  Tarn  [41]. 
Duvall  used  MACSYMA  computer  code  [14:p  3-18]  to  reduce  the  equations  prior 
to  implementing  them  in  computer  code.  For  this  effort,  a  similar  reduction  was 
performed  using  Mathematica  [48].  Tarn  calculated  the  inertia  terms  for  joints  one 
through  three  directly,  and  included  the  effects  of  joints  four  through  six  as  a  load 
on  joint  three.  This  method  is  acceptable  because  joints  four  through  six  are  being 
commanded  to  remain  at  zero  angle  by  a  separate  PD  control  loop. 

3.4.3  Kinematics  Kinematics  is  the  study  of  position  and  motion  of  an  object 
relative  to  some  reference.  Kinematics  does  not  deal  with  the  effects  of  forces.  In  a 
robotic  manipulator,  the  task  generally  involves  locating  and  moving  an  object  from 
some  point  to  another  in  the  workspace.  A  majority  of  manipulators  are  controlled 
at  the  primitive  level  in  joint  space.  However,  a  majority  of  tasks  are  best  described 
and  controlled  in  a  cartesian  space.  The  challenge  with  manipulator  kinematics  is  to 
understand  what  joint  space  motions  produce  a  desired  cartesian  motion,  or  which 
cartesian  motions  produce  the  certain  joint  motion. 

The  fundamental  aspect  of  kinematics  is  identifying  the  different  coordinate 
axes  necessary  to  translate  end  effector  values  into  the  reference  frame  coordinates. 
For  an  V  DOF  manipulator  there  can  be  ‘n’  different  coordinate  frames.  To  provide 
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a  systematic  and  standardized  way  of  assigning  coordinate  frames  to  a  manipulator, 
Denavit  and  Hartenburg  [12,  15]  developed  a  method  which  is  simple  and  straight 
forward.  On  this  theme  Fu,  Gonzalez,  and  Lee  [15]  describe  a  composite  of  all 
the  separate  frame-to-frame  rotation  matrices  as  the  homogenous  transformation  or 
hand  matrix.  The  hand  matrix  describes  the  position  and  orientation  of  the  end 
effector  with  respect  to  the  reference  frame  given  specified  joint  angles  and  the  DH 
link  parameters.  This  four-by-four  matrix  is 
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where  n,  s ,  and  a  are  the  normal,  sliding  and  approach  vectors  which  are  the  con¬ 
ventions  established  to  identify  the  position  and  orientation  of  the  end-effector  [15]. 
The  nasp  coordinate  frame  attached  to  an  end  effector  is  shown  in  Figure  3.5.  The 
hand  matrix  is  used  to  compute  reference  (world)  frame  forces  and  moments,  from 
nsap  frame  forces  and  moments. 

There  are  two  categories  of  kinematic  concern  for  robot  manipulators  [15:pl2]: 
direct  or  forward,  and  inverse  or  back.  Direct  kinematics  determines  the  position 
and  orientation  of  the  manipulator  end-effector  given  the  joint  positions  and  some 
characteristic  geometric  parameters  for  the  manipulator.  Inverse  kinematics  is  de¬ 
termining  the  necessary  joint  positions  to  obtain  a  specified  cartesian  position  and 
orientation.  For  this  thesis  the  bulk  of  conversions  will  employ  direct  kinematic 
schemes  in  order  to  convert  force  sensor  frame  data  into  the  reference  world  frame 
coordinates.  Currently,  inverse  dynamics  is  used  to  gather  position  data  for  graph¬ 
ing.  Closely  related  to  position  conversions,  is  the  need  to  determine  force-to-torque 
and  cartesian-to-joint  space  velocities.  These  conversions  are  accomplished  through 
the  Jacobian  and  inverse  Jacobian  matrices. 
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Figure  3.5.  Representation  of  the  NSAP  Direction  [15] 


3-4-3. 1  Jacobian  The  Jacobian  is  described  in  detail  in  several  references 
[15,  6,  25]  and  is  based  on  the  relationship  between  joint  and  cartesian  velocities. 

x=Jq  (3.11) 

Derivation  of  the  Jacobian  was  calculated  by  taking  the  derivative  of  the  end  effector 
position  vector.  This  position  vector  identifies  the  location  of  the  end-effector  origin 
and  is  identified  in  the  above  hand  matrix  by  the  fourth  column,  the  p,  values. 
Putting  the  time  derivative  of  the  position  vector  with  respect  to  each  of  the  joint 


angles  in  matrix  form  produces  the  three  by  three  Jacobian  matrix  used  in  this  thesis. 


J(q) 


dPx 

dpx 

d£x. 

de  j 

de2 

de 3 

dpu 

dpv 

dp» 

de , 

de2 

de  3 

it*. 

dp. 

dRj. 

dS  i 

de2 

de i 

(3.12) 


Thus,  when  the  joint  angles  and  velocities  are  known,  the  cartesian  velocities  can  be 
found  from  Equations  3.12  and  3.11.  The  inverse  Jacobian  allows  the  determination 
of  joint  velocities  if  joint  positions  and  cartesian  velocity  are  known. 


q  =  J  xx 


(3.13) 


The  Jacobian  transpose  is  used  to  relate  cartesian  forces  and  moments  to  joint 
space  torques.  As  noted  earlier,  the  PUMA  is  controlled  at  the  primitive  level  by 
commanding  torques  to  each  joint.  These  torques  are  then  converted  to  servo  motor 
currents.  The  trail  to  converting  force  sensor  values  to  joint  torques  begins  with  the 
hand  matrix  which  converts  forces  from  sensor  frame  to  world  frame  forces.  These 
.tre  next  converted  to  joint  torques  via  the  Jacobian  transpose: 

t  —  JT  F  (3.14) 

Where  r  is  joint  torque  vector,  JT  is  the  Jacobian  transpose,  and  F  is  the  cartesian 
force  vector. 


S.5  FORTRAN  Implementation  of  the  Control  Law 

The  control  law  was  coded  in  to  VMS  FORTRAN  using  the  kinematic  rela¬ 
tionships  and  the  Jacobian  described  above,  along  with  the  diagonal  M,  B,  and  K 
matrices.  A  complete  listing  of  selected  FORTRAN  programs  can  be  found  in  [2], 
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3.5.1  Feedforward  Gravity  For  a  serial  manipulator  like  the  PUMA,  the  axis 
of  rotation  for  the  two  heavy  links  is  perpendicular  to  the  gravity  field  making 
these  links  greatly  influenced  by  gravity.  Gravity  compensation  is  accomplished  by 
including  a  modeled  gravity  effect  as  a  feedforward  term  in  the  compliant  controller. 
Again,  the  work  of  Tarn  served  as  a  basis  for  calculations.  With  its  axis  co-linear 
with  the  gravity  field,  joint  one  gravity  effects  are  neglected  [41]: 

Cx  =  0.0 

C2  =  C3~  ga2m3cos(q2 ))  +  gm2[y2sin(q2 )  -  (x2  +  a2)eos(g2)] 

C3  =  -gm3[(x3  +  a3)cos(q2  +  q3)  ~  z3sin(q2  +  q3)}  (3.15) 


where: 

g  is  gravity  =  9.8  meters / sec2 

a2,a3  are  the  Denavit-Hartenburg  parameters  for  links  2  and  3 

m2,m3  are  the  masses  for  links  2  and  3 

^3,z3,y2  are  the  first  moments  of  those  axes  [14:p3-20] 

S.5.2  Feedforward  Friction  The  complicated  nature  of  friction  effects  and 
compensation  was  described  in  the  previous  chapter.  A  description  of  the  type  of 
compensation  used  in  the  FARCADE  algorithm  is  now  provided.  The  friction  model 
used  for  this  research  was  identical  to  that  used  by  Milholen  [34].  Summarizing, 
Milholen’s  choice  was  based  on  previous  studies  that  identified  the  complexity  of 
accurate  compensation  through  non-adaptive  modeling.  That  discussion  identified 
two  critical  elements  of  a  friction  compensation  scheme  for  this  effort: 

Generality  Ability  to  address  the  most  dominant  friction  effects  at  the  relatively 
slow  task  speeds  encountered  in  the  compliant  refueling  environment.  These 
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effects  were  identified  by  Milholen  as  stiction(static),  coulomb,  and  viscous  fric¬ 
tions  [34]. 

Simplicity  The  complexity  of  implementation  must  be  limited.  The  total  compu¬ 
tational  time  required  for  friction  plus  the  remaining  control  law  must  allow  for 
computations  at  or  below  the  desired  operating  frequency. 


With  these  restrictions  Milholen  used  the  composite  stiction,  coulomb,  viscous  model 
described  by  Equation  3.16  and  depicted  in  Figure  2.10. 


{Tcsgn(q)  (|g|)  >  d 
Tcsgn(rm)  (|$|)<d 


(3.16) 


where: 


tc  is  the  compensation  torque  (90  %  of  experimentally  determined  value  for 
stiction) 

sgn(-)  is  the  function  returning  the  sign  of  its  argument 

q  is  the  joint  velocity  in  rad/sec 

r-m  is  the  torque  supplied  to  the  motor 

d  is  a  velocity  threshold  also  determined  experimentally 

The  choice  of  the  switching  threshold  parameter  d  was  determined  by  experimenta¬ 
tion  to  be  0.01  (34,  31].  Choosing  the  sign  of  rm  for  values  less  than  the  threshold  is 
used  from  the  assumption  that  static  friction  has  overcome  motion  in  this  realm. 


8.5.3  Non-Impefonce  Control  Implementation  of  impedance  control  was  ap¬ 
plied  to  three  of  the  six  joints  of  the  PUMA  manipulator.  Joints  four  through  six 
were  controlled  by  a  classical  proportional  derivative  control  scheme  implemented  in 
joint  space.  The  large  assumption  of  this  impedance  controller  was  that  the  wrist 
joints  were  essentially  a  solid  extension  of  joint  three.  By  commanding  the  desired 
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joint  positions  and  velocities  to  be  zero,  a  form  of  electronic  brake  was  applied  to 
these  joints.  The  resulting  PD  control  law  reduces  to 

r  =  -I<pq  -  Kvq  (3.17) 

Values  of  Kv  and  Kv  were  chosen  by  Milholen  and  were  not  changed  here.  Du¬ 
vall  [14:3-34]  and  Milholen  [34:3-23]  noted  that  by  changing  the  gains  on  the  PD 
controlled  joints,  varying  degrees  of  electronic  passive  complir.noe  can  be  achieved. 
They  applied  this  concept  to  provide  a  small  degree  of  compliance  in  the  cartesian 
‘y’  plane  by  implementing  softer  gains  on  joint  one. 

3.5.4  FARCADE  FARCADE  is  written  in  VMS  FORTRAN  and  contains  all 
the  communication  and  subroutine  calls  necessary  to  operate  the  PUMA  manipulator 
in  impedance  mode.  It  also  calls  the  manipulator  and  force  sensor  calibration  rou¬ 
tines.  The  impedance  controller  is  actually  a  sub-routine  within  FARCADE  called 
MBFC_RT.  The  following  sub-subsection  titles  represent  a  FARCADE  sub-routine 
name. 


3.5.4-1  MBFC-RT  This  is  where  the  .lacobians,  inertia,  M ,  B,  K,  grav¬ 
ity,  and  friction  are  all  combined  to  create  the  total  torque  required  for  driving  the 
joint  motors.  MBFC.RT  is  called  each  time  step  calculating  new  values.  These 
torque  values  are  sent  to  the  coordinator  level  and  then  to  the  PUMA  servos.  The 
total  torque  values  are  divided  into  four  categories: 

Force  Torques  due  to  sensed  interface  forces.  Final  value  obtained  by  the  following 
combination  of  the  these  terms:  —  [JT  -f  I  J~l  A/-1]  F,n< 

Position  Torques  due  to  cartesian  position  errors.  Computed  from  these  term: 
1  J~'  A/"1  A'[*0  -  1(9)]  +  S(q). 

Velocity  Velocity  related  torques  calculated  from:  -f/J-1  A/-1  B\v 0—  Jq ]  -f  V(q). 
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Feed-forward  Gravity  and  friction.  The  gravity  term  is  generally  included  with  the 
position  dependent  terms  as  shown  by  S(q)  above.  Friction  torque  is  calculated 
separately  using  as  a  basis  Equation  3.16. 

3. 5.4 -2  CARTFOR  Employs  a  two-step  process  to  convert  sensed  forces 
to  world  frame  values.  First,  force  sensor  calibration  bias  is  removed.  Next,  these 
forces  are  converted  to  the  world  frame  using  the  band  matrix.  Once  converted, 
these  forces  are  used  in  MBFCJRT  to  create  the  portion  of  total  torque  related  to 
interface  forces.  This  routine  is  also  executed  each  sample  period. 

3.5. 4. 3  KIN  Calculates  the  hand  matrix  each  sample  period.  Once  cal¬ 
culated,  the  values  are  combined,  in  MBFC  JRT,  with  forces  from  CARTFOR.  KIN 
is  also  used  to  establish  the  starting  position  in  the  trajectory. 

3.6  Summary 

This  chapter  has  defined  the  test  environment  used  in  this  thesis.  The  envi¬ 
ronment  consists  of  computers,  a  PUMA  manipulator,  a  force  sensor,  the  refueling 
mock-up,  and  the  software  operate  and  support  the  environment.  The  following 
chapter  will  set  the  stage  for  the  actual  research  performed,  bv  discussing  some 
issues  that  needed  to  be  resolved  prior  to  full-scale  experimentation. 
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IV.  Anomalies 


4-1  Overview 

During  the  FORTRAN  coding  and  subsequent  ‘shakedown’  testing  of  the  three 
DOF  impedance  control  law,  three  anomalies  in  the  previous  two  DOF  effort  were 
identified.  This  chapter  will  explain  the  anomalies,  and  the  steps  taken  to  correct 
them. 

4-2  Two  DOF  Impedance  Controller 

The  complex  nature  of  implementing  impedance  control  provides  an  atmosphere 
of  mistakes  and  mis-cues.  Assuming  that  all  parameters  are  correct,  proceeding  from 
a  two  DOF  impedance  controller  to  a  three  DOF  controller  is  simply  done  by  expand¬ 
ing  the  two-by-two  matrix  form  of  Equation  2.3.  It  was  during  this  implementation 
process,  that  errors  in  the  previous  two  DOF  FORTRAN  code  were  discovered.  The 
following  subsections  discuss  the  data  file  read  error,  and  the  run-time  constants. 

4-2.1  Data  File  Read  Error  One  of  the  FARCADE  subroutines,  IMPCONST, 
reads  in  data  that  define  the  M  and  B  values.  These  are  part  of  the  ‘desired’  coeffi¬ 
cients  that  make  up  the  second  order  spring-mass-damper  model  used  to  characterize 
the  manipulator  impedance.  Milholen’s  implementation  of  this  read  routine  inverts 
the  order  of  these  terms,  effectively  making  the  desired  mass  term  read  as  the  desired 
damping  term  and  visa  versa.  Once  this  re?d  is  done  the  same  subroutine  creates 
the  constants  which  are  later  used  in  the  subroutine  MBFCJIT  to  calculate  actual 
joint  torques.  All  impedance  control  law  calculations  done  in  MBFCJIT  rely  on  the 
off-line  constants  created  by  IMPCONST. 

From  Equation  2.3,  it  is  evident  that  the  mass  matrix  used  in  computing  the 
control  law  is  actually  applied  in  its  inverted  form;  thus  in  the  FORTRAN  code  M  is 
actually  M~x .  This  mass  term  is  utilized  in  the  force,  position,  and  velocity  torque 
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terms.  Any  error  in  mass  terms  will  affect  each  of  these  torque  terms.  The  damping 
term  B  is  used  in  its  un-inverted  form,  and  is  used  to  calculate  only  the  velocity 
torques. 

4-2.2  Run-Time  Constants  The  subroutine,  MBFCJRT,  is  the  heart  of  the 
impedance  calculations.  The  two  DOF  version  contained  constants  which  were  used 
in  the  position  and  velocity  torque  calculations.  These  constants  have  no  basis  in 
the  theory  supporting  this  control  law.  The  following  is  a  comparison  of  what  the 
theory  states  versus  what  was  implemented  in  the  two  DOF  code: 

Theory 

PositionTorque  -■  I  J-1  K[x0  —  L(q)]  (4-1) 

VelodtyTorque  —  I  J~l  M~x  B[vq  —  J q]  (4-2) 

Two  DOF  FORTRAN  Implementation 


PositionTorque  = 

100(7  J"1  M~l  K\x0  -  L(q)})) 

(4.3) 

VelodtyTorque  = 

I  J-1  AT1  B[v0-m  Jq] 

(4.4) 

The  constant  100  identified  by  the  overbrace  is  the  unsupported  term.  In  a 
phone  conversation  with  Capt  Milholen  [35],  this  constant  was  discussed.  Evidently, 
the  constant  value  was  generated  as  a  result  of  a  trial  and  error  attempt  to  make  the 
two  DOF  impedance  controller  function.  After  encoding  and  performing  individual 
subroutine  checks,  Milholen  found  that  the  two  DOF  controller  produced  no  motion. 
After  several  attempts,  the  above  constants  provided  manipulator  motion.  The 
underlying  cause  for  the  need  to  use  these  constants  originates  from  the  IMPCONST 
data  read  error. 

4-2.3  Implications  With  these  two  changes  to  the  two  DOF  approach,  the 
three  DOF  implementation  was  accomplished.  Initially  all  values  for  desired  mass, 
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damping,  and  spring  constants  duplicated  the  values  used  by  Milholen  [34:Table  4.4]. 
These  values  are  found  in  Table  4.1. 


Table  4.1.  Two  DOF  Assumed  Parameters  [34:4-13] 


Test 

Trajectory 

c 

«n 

M 

B 

I< 

T5 

Refueling 

1.2 

7.0 

2.041 

34.29 

100.0 

Test  runs  of  the  three  DOF  controller  produced  extreme  instability  in  the  ma¬ 
nipulator.  Following  several  attempts  to  identify  the  unstable  behavior,  a  study  was 
done  to  characterize  how  the  two  DOF  implementation  errors  changed  the  second 
order  system  model.  A  summary  of  the  study  results  follows. 

Assuming  the  desired  values  as  identified  by  Table  4  1,  and  evaluating  Equa¬ 
tion  3.6  based  on  the  transposed  read,  the  following  parameters  result: 


K_ 

M 


w; 


55%  =  2.9163 


(4.5) 


M 


-  2(wn 


2.041 

34.29 


0.0595 


Table  4.2  compares  the  values  for  £  and  based  on  theory,  with  those  shown  in 
Equation  4.5. 

Table  4.2.  Comparison:  Theory  vs  T  wo  DOF  Implementation 


Source 

C  J 

wn 

M 

B 

I< 

Theory 

1.2 

7.0 

2.041 

34.29 

100.0 

2  DOF 

0.0174 

0.0595 

34.29 

2.041 

100.0 

It  is  clear  from  this  comparison  that  the  values  implemented  in  the  two  DOF 
controller  varied  drastically  from  what  the  second  order  model  predicts.  These  were 
the  values  that  were  being  implemented  in  the  control  law  that  Capt  Milholen  at¬ 
tempted  to  run  prior  to  add'ng  the  constants.  From  Equations  4.3  and  4.4  an 
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‘effective’  value  can  be  obtained  by  the  following: 


100g  =  =  100 3^  =  291.63 

lOOg  =  2(u>n  =  lOO^g  =  5.950 


(4.6) 


Note  that  the  term  assumes  that  i’o  is  small  in  comparison  to  100J^.  With  the 
values  obtained  from  these  ‘effective’  spring-mass-damper  terms,  a  final  comparison 
of  terms  in  made  in  Table  4.3. 


Table  4.3.  Comparison:  Theory,  Two  DOF  Implementation  and  Effective 


Source 

c 

OJn 

■a 

a 

Theory 

1.2 

7.0 

2.041 

34.29 

o 

o 

-  8.400 

2  DOF 

0.0174 

1.7078 

100 

-  0.029 

Effective 

0.1740 

17.078 

34.29 

204.02 

10000 

-  2.973 

Although  the  choice  M,  B ,  and  K  are  arbitrary,  they  must  satisfy  the  condi¬ 
tions  for  stability,  desired  damping,  and  natural  frequency.  There  is  an  additional 
restriction  imposed  to  avoid  pole  warping  which  occurs  when  using  a  digital  system 
to  approximate  a  continuous  one  [23,  14,  34],  Equation  4.7  describes  this  condition. 


*  >  -Jr-  (4.7) 

For  the  current  configuration,  the  sample  rate  T,  is  5.4  milliseconds.  Thus,  the 
additional  restriction  is  found  in  Equation  4  8. 

"  -  -7T  =  =  -18-52  rad/sec  8) 

Remembering  that  a  —  —( ion,  and  using  the  effective  values  calculated  above, 
the  two  DOF  freedom  control  law  implementation  met  this  criteria,  as  shown  in 
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Equation  4.9. 


a 

-(0.1742)  (17.078) 


■C^n 


-0.1 

T. 


—2.97  >  --18.52  rad/sec 


(4.9) 


4- S  Foret  Errors 

During  the  initial  testing  of  the  three  DOF  controller,  it  became  evident  that 
some  of  the  torque  values  were  incorrect  in  direction.  To  isolate  the  error  required 
several  steps.  First,  to  verify  the  translation  of  forces  from  the  tool  frame  to  the 
world  frame.  Second,  assure  that  the  conversion  from  world  forces  to  joint  torques 
was  correct. 


4.S.1  Force  Conversions:  Tool  Frame  to  World  Frame  The  first  area  exam¬ 
ined  was  the  n„ap  kinematic  transformation  matrix.  To  test  for  this  type  of  error, 
the  calculations  the  transformation  matrix  were  first  re-checked.  Next,  a  simula¬ 
tion  program  was  created  using  the  pertinent  FARCADE  software  subroutines  and 
running  various  arm  configurations  and  fictitious  input  forces.  The  goal  here  was 
to  check  for  appropriate  magnitudes  and  signs  on  the  resultant  forces.  During  this 
exercise  it  was  discovered  that  the  force  sensor  coordinate  frame  was  in  error.  Fol¬ 
lowing  the  same  convention  used  in  the  previous  research,  it  was  assumed  that  the 
force  sensor  and  world  coordinate  frames  were  aligned  when  the  PUMA  was  in  the 
(0°,  90°,  —90°)  position.  However,  in  actuality  the  coordinate  frames  were  aligned 
in  the  z  and  x  axes,  but  were  180°  out  of  phase  in  the  y  axis.  This  situation  went 
undetected  by  previous  researchers  because  only  the  x  and  z  force  values  were  used 
by  the  two  DOF  control  law.  Once  discovered,  this  error  was  corrected  in  the  appro¬ 
priate  places  within  the  computer  code.  Force- to- torque  checks  were  done  to  assure 
no  other  conversion  errors  existed. 
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4.8.2  Force  to  Torque  Conversion  The  final  area  to  check  for  the  force  related 
errors  was  in  the  conversion  from  forces  to  torques.  This  conversion  involves  the 
maos  matrix,  jacofcian  transpose,  jacobian  inverse,  and  the  inertia  matrix.  Each  of 
these  terms  was  rechecked  for  theoretical  accuracy.  None  of  these  terms  identified 
any  inaccuracies. 

4-4  Joint  One  Data  Corruption 

As  initial  three  DOF  testing  continued,  an  error  in  the  cartesian  ‘x’  position 
data  was  encountered.  The  same  error  was  evident  in  the  joint  one  data  plots.  It 
was  manifest  by  position  spikes  as  the  manipulator  traversed  the  desired  trajectory. 
As  the  manipulator  traveled  down  the  slipway  sidewall,  the  position  plots  for  joints 
two  and  three  reflected  a  solid  connected  line  representing  actual  position.  Joint  one 
data,  showed  spikes  that  started  at  the  zero  position  and  jumped  to  some  non- zero 
value.  Because  the  manipulator  was  physically  restrained  by  the  slipway  sidewall 
from  returning  to  zero,  it  was  determined  there  was  some  error  in  the  data  repre¬ 
senting  joint  one  position.  When  the  non-zero  endpoints  of  the  position  spikes  were 
connected  with  line  segments,  the  resulting  curve  represented  the  actual  joint  posi¬ 
tion.  This  suggested  that  the  joint  one  data  had  correct  values  initially,  yet  at  some 
point  most  of  that  data  was  being  corrupted  with  zeros.  Further  investigation  of  the 
issue  determined  that  the  Assembly  level  code  was  somewhere  causing  the  drep-out 
or  corruption  of  the  data.  In  order  to  continue  research,  a  temporary  fix  was  imple¬ 
mented.  This  simple  fix  reads  the  values  for  joint  one  angles  comparing  them  with 
the  previous  values.  If  the  current  value  is  smaller  than  the  previous,  the  previous 
value  is  retained.  This  is  possible  to  implement  because  the  constraint  surface  never 
changes  between  positive  and  negative  slope  on  the  same  run.  Figure  4.1  shows  the 
original  spiky  data  with  the  continuous  line  resulting  from  the  fix,  superimposed  on 
the  spikes. 
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4-5  Summary 

This  chapter  identified  the  anomalies  found  in  the  previous  two  DOF  impedance 
control  implementation.  In  conjunction,  a  brief  chronology  of  the  changes  made  to 
produce  a  functional  two  DOF  controller  was  reviewed.  The  resulting  data,  found  in 
Table  4.3,  summarizes  the  conditions  actually  functioning  in  the  two  DOF  version 
of  impedance  control.  Next,  error  in  the  force  related  torques  required  a  review  of 
the  governing  equations  used.  As  a  part  of  that  review,  the  force  sensor  coordinate 
frame  error  was  uncovered.  Finally,  the  joint  one  data  corruption  issue  was  revealed, 
and  a  fix  sufficient  to  continue  testing  was  implemented.  A  complete  fix  will  be 
required  for  future  studies.  The  following  chapter  begins  evaluating  the  three  DOF 
impedance  controller  using  the  conditions  of  Table  4.3  as  a  starting  point. 


V.  Results  and  Evaluation 


5.1  Overview 

The  previous  chapters  described  the  tools  needed  to  create,  test  and  verify  a 
three  DOF  impedance  controller.  This  chapter  presents  the  details  of  implement¬ 
ing  the  three  DOF  compliant  control  law.  Testing  began  by  applying  the  effective 
impedance  values  used  on  the  two  DOF  controller,  to  the  current  control  scheme 
for  three  DOF.  Three  DOF  compliance  was  demonstrated  during  this  phase.  Using 
the  two  DOF  initial  parameters  as  a  spring-board,  the  values  for  desired  mass(M), 
damping(B),  and  stiffness(K)  in  the  impedance  controller  were  adjusted  in  a  ‘tun¬ 
ing’  process  to  obtain  improved  performance.  Force  and  velocity  filters  were  applied 
in  order  to  smooth  out  the  torque  profiles.  With  smoother  torque  profiles,  friction 
compensation  was  evaluated. 

5.2  Initial  Conditions 

5.2.1  Trajectory  Once  the  theory  was  coded  in  FORTRAN,  the  control 
law  was  exercised.  As  a  reference  point  for  comparison,  the  effective’  values 
for  the  previous  two  DOF  control  law  were  applied  to  the  three  DOF  control 
law.  All  tests  were  performed  with  the  refueling  trajectory  used  by  Milholen 
[34]  which  is  depicted  in  Figure  5.1.  The  solid  outline  represents  a  side  view 
of  the  refueling  apparatus.  The  refueling  trajectory  starts  at  the  world  xyz  po¬ 
sition  (—0.800m,  0.149m, —0.201m)  then  moves  in  the  —  z  direction  to  the  point 
(—0.800m,  0.149m, —0.325m).  From  that  point,  movement  is  in  the  —  x  direction 
with  termination  at  (—1.060m,  0.149m, —0.325m).  This  particular  trajectory  only 
requires  commanded  movement  in  joints  two  and  three  to  meet  the  xz  position  re¬ 
quirements.  Joint  one  is  commanded  to  remain  stationary.  Initially  this  appears  to 
be  a  limiting  case  which  doesn’t  exercise  all  aspects  of  the  three  DOF  controller. 
However,  because  the  refueling  table  is  adjustable,  the  slipway  can  be  set  such  that 
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Figure  5.1.  Refueling  Trajectory  [34:4-13] 

joint  one  is  deflected  from  the  zero  commanded  position.  The  ability  to  position  the 
physical  constraint  provides  a  mechanism  to  evaluate  various  degrees  of  compliant 
motion.  To  avoid  equipment  damage  from  unstable  behavior,  each  set  of  conditions 
was  initially  performed  in  free  space  prior  to  contact  with  the  refueling  table. 

5.2.2  Fixture  Positioning  Due  to  variations  in  PUMA  calibration,  it  was  not 
possible  to  place  the  refueling  table  in  the  same  location  each  time.  At  times  cal¬ 
ibration  variations  would  place  the  manipulator  much  lower  in  the  z  axis  direction 
than  others.  To  accommodate  this,  the  table  was  adjusted  in  the  x  axis  direction. 
Though  not  as  severe,  calibration  positioning  was  also  inconsistent  in  the  y  axis. 
Therefore,  placement  of  the  refueling  table  in  the  x  and  y  axis  directions  was  not 
identical  for  each  test  case. 

5.2.3  Data  Plots  All  of  the  data  plots  presented  in  this  chapter  were  created 
by  sampling  every  fifth  point  out  of  the  original  data  files.  The  original  data  files 
contained  5555  data  points.  It  was  found  that  plotting  out  all  of  the  raw  points 
created  an  extremely  difficult  plot  to  analyze.  The  plots  shown  in  this  chapter, 
contain  1111  data  points.  A  careful  comparison  of  the  full  data  plot  with  the  reduced 
size  revealed  no  significant  degradation  in  the  information  portrayed. 
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5.3  Three  DOF  Compliance 


5.3.1  Verification  The  first  formal  phase  of  testing  used  the  ‘effective’  param¬ 
eters  found  in  Table  4.3.  Figure  5.2  provides  insight  into  the  tracking  capability  of 
this  parameter  set.  As  expected  from  Milholen’s  results,  this  configuration  tracks 
the  desired  trajectory  quite  well.  The  z  axis  plot  reveals  the  characteristic  stair-step 
motion  which  is  indicative  of  stiction.  The  presence  of  stiction  in  this  case  is  possi¬ 
ble  since  the  test  was  made  with  no  friction  compensation.  Friction  compensation  is 
addressed  later  in  the  chapter. 

The  next  step  was  to  verify  that  the  three  DOF  controller  could  perform  two 
dimensional  constrained  compliant  motion.  This  task  was  accomplished  by  running 
the  trajectory  with  the  refueling  platform  aligned  in  the  XZ  plane.  Figure  5.3  rep¬ 
resents  the  torque  profile  resulting  from  the  two  DOF  insertion.  As  expected,  the 
position  and  total  commanded  torque  were  nearly  identical  for  joint  one.  For  this 
two  DOF  case,  joint  one,  which  corresponds  to  the  y  axis  direction,  did  not  encounter 
an  obstacle.  Joints  two  and  three  encountered  the  slipway  causing  force  and  position 
error  in  these  directions.  Figure  5.3  displays  the  resulting  torque  profiles  quite  well. 

The  small  torque  on  joint  one  is  due  to  irregularity  in  the  slipway  surface  com¬ 
bined  with  slight  sensor  variations,  there  was  some  sensed  force  in  that  direction. 
The  data  for  joints  two  and  three  show  that  as  the  position  torque  varies,  the  force 
torque  responds  in  the  reverse.  This  is  the  desirable  nature  of  impedance  control. 
The  constant  interplay  between  the  position  and  force  torques  is  what  allows  com¬ 
pliance  to  work.  Once  the  two  DOF  capability  was  established,  all  three  degrees  of 
freedom  were  exeidsed. 

5.3.2  Three  DOF  Compliance  This  test  was  set  up  by  placing  the  refueling 
platform  offset  in  the  plus  or  minus  y  direction. Initially,  the  the  nozzle  remained 
parallel  to  the  slipway  sidewall.  Eventually,  the  slanted  sidewall  created  an  angle 
whose  effect  was  to  increase  the  position  error,  similar  to  placing  a  wedge  along  the 
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Figure  5.2.  Freespace:  Desired  vs  Actual  Cartesian  Trajectory 
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Figure  5.3.  Constrained:  Torque  Profiles,  Effective  Parameters  XZ  Compliance 


trajectory,  as  the  manipulator  continued  in  the  -x  direction. The  resultant  torque 
profile  is  shown  in  Figure  5.4.  The  joint  one  plot  clearly  shows  the  mirror  nature  of 
force  and  position  torque.  This  effect  is  also  evident  in  the  other  two  joint  torques. 

In  addition  to  verifying  compliance  in  each  of  the  three  degrees  of  freedom, 
Figure  5.4  reveals  some  other  characteristics.  First,  the  data  in  the  plots  for  joints 
two  and  three  is  especially  rough.  The  force  torques  are  oscillating  at  a  relatively  high 
frequency.  This  was  the  motivation  for  force  filtering  which  is  discussed  in  a  latter 
section.  Additionally,  the  jcint  one  plot  shows  that  even  though  the  force  torque 
counters  the  increase  in  position  torque,  it  only  partially  nullifies  the  increase.  This 
means  that  there  was  a  ner.  inc  ease  in  total  torque  in  the  direction  of  the  sidewall. 
The  physical  evidence  of  this  let  force  was  seen  by  observing  slight  flexure  in  the 
refueling  fixture  support  strut  .ure.  No  damage  was  done  because  the  support  frame 
is  not  extremely  rigid.  This  ret  force  issue  is  discussed  in  the  tuning  section. 

5-4  ‘ Tuning ’ 

The  term  tu;  ing  here  refers  to  improving  performance  through  variation  of 
the  impedance  controller  second  order  parameters  M,  B ,  and  K.  Chapter  Three 
described  the  relation  between  these  parameters  and  the  damping  ratio  and  natu¬ 
ral  frequency.  This  section  will  present  the  tuning  results  by  actually  varying  the 
damping  ratio,  £,  the  natural  frequency,  and  mass. 

5  4-1  Damping  Ratio  Although  the  above  control  law  verified  compliance  in 
all  three  directions,  the  desired  parameters  created  a  small  damping  ratio.  Clas¬ 
sic  control  theory  suggests  that  such  small  values  for  damping  ratio  allow  for  the 
possibility  of  overshoot  and  longer  periods  of  oscillation,  which  are  not  desired  in 
impedance  control.  Figure  5.5  represents  the  constrained  position  trajectory  plot 
that  results  from  three  different  damping  rat  os.  This  figure  clearly  shows  that  there 
is  little  change  in  trajectory  tracking  performance  between  (  =  0.174  and  (  —  1.4. 
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Figure  5.4.  Constrained:  Torque  Profiles,  Effective  Parameters  XYZ  Compliance 
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Figure  5.6,  illustrates  the  torques  corresponding  to  the  £  =  1.4  trajectory  plot  of 
Figure  5.5,  Comparing  Figures  5.5  and  5.6  reveals  only  a  slight  variation  in  the 
torque  profiles  for  the  (  =  0.174  and  the  £  =  1.40  case.  The  one  noticeable  feature 
is  the  noisier  force  torques  for  higher  damping  ratios. 

So  far,  the  only  benefit  gained  from  increasing  the  damping  ratio  is  that  the 
system  should  theoretically  be  more  stable,  not  allowing  for  overshoots  and  many 
oscillations.  From  visual  observation  the  performances  are  identical.  In  addition, 
careful  examination  of  Figure  5.6  reveals  that  there  is  an  additional  amount  of  higher 
frequency  torque  and  some  spikes  that  do  not  correspond  to  the  force  terms.  Evalu¬ 
ating  the  velocity  torque  profiles  shows  a  pattern  like  that  on  the  total  torque  line. 
Figure  5.6  shows  the  results  of  increased  damping  ratio  on  total  torque,  as  compared 
to  total  torque  for  £  =  0.174  shown  in  Figure  5.4.  Because  damping  is  directly 
related  to  velocity,  any  increase  in  the  damping  ratio  will  have  a  similar  increase  in 
the  magnitude  of  velocity  related  torque.  In  the  case  where  the  velocity  terms  are 
noisy,  increasing  the  damping  will  increase  that  noise.  This  is  the  reason  velocity 
filtering  will  be  discussed  later  in  the  chapter. 

5.4.2  Natural  Frequency  Variation  of  the  natural  frequency,  u was  done  in 
an  attempt  to  create  a  better  force  to  position  torque  balance.  As  mentioned  earlier, 
the  ideal  case  has  the  force  torque  equally  matching  the  position  torque  arising  from 
the  error  induced  by  the  obstacle.  The  natural  frequency  term  is  comprised  of  the 
square  root  of  the  stiffness  K  divided  by  the  desired  mass  M.  The  approach  to  match 
torques  was  accomplished  by  lowering  the  position  gain.  Varying  this  gain  has  the 
effect  of  changing  the  natural  frequency.  Another  approach  is  to  choose  a  desired 
natural  frequency,  and  find  the  mass  and  stiffness  combination  that  will  satisfy  that 
condition.  Figure  5.7  presents  the  torque  profiles  resulting  from  a  natural  frequency 
of  07  radians  per  second.  The  point  to  remember  is  to  evaluate  these  plots  based 
on  the  relative  change  in  slope  of  the  torque  curves,  not  on  the  absolute  torque 
magnitudes.  One  of  the  reasons  for  this  is  that  the  desired  result  is  to  allow  force 
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induced  torques  to  nullify  the  change  in  position  torque  due  to  the  error  generated 
from  the  obstacle.  For  joint  one  this  means  the  ideal  total  torque  curve  would  be  flat 
even  when  encountering  obstacles  in  that  u^ection.  Another  reason  is  that  fixture 
positioning  can  change  the  torque  magnitude  from  run  to  run  for  the  same  parameter 
set. 

This  exercise  demonstrates  that  the  force  torque  term  has  more  dominance  at 
this  frequency,  than  in  the  u>  =  18.52  case  of  Figure  5.4.  However,  the  position 
torque  still  dominates  and  causes  the  total  torque  slope  to  increase.  Also  apparent 
is  the  high  frequency  ‘noise’  from  the  force  torque.  From  this  exercise,  one  sees  that 
varying  the  position  gain,  i.e.  stiffness,  does  in  fact  act  as  a  method  to  reduce  the 
position  torque  influence. 

5-4-3  Mass  Another  approach  to  reducing  the  effect  of  position  torque  is  sim¬ 
ilar  to  the  natural  frequency  approach.  Because  Hogan’s  law  uses  the  inverse  mass, 
decreasing  the  mass  term  acts  to  increase  the  magnitude  of  the  overall  term.  How¬ 
ever,  unlike  changing  the  stiffness,  in  this  case  varying  the  mass  term  affects  all  of 
the  other  torque  terms  in  the  controller,  i.e.  force,  velocity,  and  position  torques. 
Thus,  as  the  mass  term  i3  reduced,  the  torques  for  force,  position,  and  velocity  will 
each  increase  in  magnitude.  Assuming  a  constant  natural  frequency,  when  mass 
is  reduced,  the  stiffness  term  must  also  be  reduced  to  maintain  that  frequency.  A 
similar  effect  occurs  with  the  damping  torque.  On  the  other  hand,  decreasing  the 
mass  will  directly  increase  the  force  torque  magnitude.  The  result  is  an  increase  in 
the  force  torque,  with  no  relative  increase  in  position  torque.  Figure  5.8  represents 
torques  created  by  reducing  the  desired  mass  from  34.28  kg  to  5.0  kg.  For  joints 
one  and  two,  changes  in  the  position  torque  were  nearly  canceled  by  the  correspond¬ 
ing  force  torque.  This  verifies  that  this  method  is  useful  in  tuning  the  manipulator 
performance. 


5-11 


(N-m)  Torque  (K-m) 


15.0 
10.0 
5.0 

0.0 

-5.0 

-10.0 
-15.0 

0.0  5.0  10.0  15.0  20.0  25.0  30.0 

Time  (seconds) 


Joint.  One 


Joint  One 


Joint  Two 


Joint  Three 


Total 

Posit:  on  |j 

Force,  (  =  0.174,  uin  =  18.52 
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5.5  Filters 


The  timing  effort  pointed  out  the  higher  frequency  oscillations  and  spikes  that 
originated  in  the  force  and  velocity  torques.  Both  of  these  terms  have  important 
impact  on  system  performance.  Because  the  force  portion  of  impedance  is  associated 
with  stability,  the  desired  forces  and  related  torques  should  be  as  continuous  and 
smooth  as  possible.  Velocity  torque  is  important  in  two  ways.  First  it  relates  to  the 
damping  characteristics  of  the  controller.  Second,  the  friction  compensation  model 
threshold  is  based  on  velocity.  The  sign  of  the  friction  torque  is  obtained  from  the 
direction  of  joint  velocity  if  its  greater  than  the  threshold.  Otherwise  the  sign  is 
determined  from  the  position  torque. 

The  filter  used  for  both  the  force  and  velocity  was  very  simple:  the  slope  between 
the  current  and  the  previous  point  is  calculated,  and  compared  to  a  user  selected 
value.  If  the  actual  slope  is  greater  than  the  selected  value,  the  magnitude  of  the 
current  point  is  adjusted  to  meet  the  imposed  slope  requirement.  Figure  5.9  shows 
a  run  without  the  force  filter  applied.  The  force  torque  has  the  high  frequency 
oscillations,  especially  notable  in  the  joints  two  and  three  curves.  Figure  5.10  shows 
the  torque  profile  for  the  same  conditions  with  the  force  filter  applied.  There  is  a 
definite  change  in  the  torque  curves  due  to  the  filter.  However,  the  velocity  torque 
‘noise’  is  still  present  in  the  total  torque. 

The  velocity  filter  was  applied  to  the  joint  space  velocities.  An  example  of  the 
velocity  torque  prior  to  and  after  filtering  is  in  Figure  5.11.  Figure  5.12  displays  the 
results  of  velocity  filtering  on  the  total  torques.  It  can  be  seen  from  these  plots,  the 
filter  does  remove  the  spikes  that  were  present.  This  is  important  because  a  spike  in 
the  torque  profile  can  propagate  throughout  the  entire  manipulator  and  contribute 
to  instabilities. 
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Figure  5.12.  Constrained:  Total  Torques,  mass  ~  34.28kg 
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5.6  Friction  Compensation 

Prior  to  the  temporary  fix  for  joint  one  data  corruption,  it  was  observed  that 
the  addition  of  friction  compensation  would  cause  the  manipulator  to  go  unstable 
and  enter  into  limit  cycles.  One  such  case  is  shown  in  Figure  5.13.  The  combination 
of  large  torque  spikes  from  joint  one,  and  the  cyclic  switching  of  the  friction  torque 
would  combine  to  create  the  unstable  behavior.  After  adding  the  joint  one  data 
filter,  those  types  of  limit  cycles  were  eliminated.  With  the  force,  velocity,  and 
joint  one  filters  in  place,  an  examination  of  the  friction  compensation  model  was 
performed.  Figure  5.14  shows  the  effect  of  including  the  coulomb/viscous  friction 
model  described  in  Chapter  Two.  The  heavy  torque  bands  are  due  to  coulomb 
friction.  These  are  caused  by  the  direction  switching  that  occurs  in  this  friction 
model.  Comparing  this  figure  to  Figure  5.12  reveals  that  the  torque  from  friction 
compensation  merely  adds  a  torque  band  to  the  total  torque  curve.  There  is  no 
visual  or  graphical  improvement  shown  with  this  compensation  included.  In  fact, 
from  the  mechanical  view  point,  such  oscillations  in  the  gear  train  are  not  desirable. 
Premature  failure  because  of  excessive  cycling  is  possible.  In  an  effort  to  create 
a  working  friction  model,  the  threshold  value  was  changed.  In  addition,  the  actual 
values  for  coulomb  and  viscous  friction  were  varied.  Neither  of  these  efforts  improved 
the  performance  for  friction  compensation.  Thus,  further  testing  was  performed 
without  friction  compensation  included. 

5. 7  Speed 

Until  now,  the  testing  was  done  on  a  thirty  second  trajectory.  This  part  of  the 
thesis  briefly  examines  whether  the  impedance  controller  with  similar  parameters 
can  accommodate  faster  motions.  The  data  of  Figure  5.15  represents  a  total  time 
of  five  seconds  to  traverse  the  same  trajectory  previously  covered  in  thirty  seconds. 
Some  re-tuning  of  the  various  parameters  was  required  to  create  a  combination  that 
would  remain  stable.  This  configuration  used  a  10  kg  mass,  a  damping  ratio  of  0.5, 
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Figure  5.13.  Free  Space:  Limit  Cycle 


and  a  ;  \tural  frequency  of  18.52.  Physically,  the  manipulator  followed  the  side  of 
the  slipway  in  essentially  the  same  manner  as  previous  runs,  except  six  times  faster. 
Visually  the  performance  was  identical  to  the  thirty  second  cases.  The  shape  of  the 
curves  in  Figure  5.15  appear  to  be  much  different  than  the  long  runs,  but  this  is 
expected  based  on  the  shortened  time  frame.  This  portion  of  the  research  identifies 
that  the  compliant  controller  can  function  well  over  a  broad  range  of  conditions 
including  variations  in  trajectory  speeds. 

5.8  Limitations 

A  final  observation  about  the  compliant  controller  capabilities  is  made  by  eval¬ 
uating  the  data  in  Figure  5.16.  At  the  28  second  point  there  is  a  large  increase  in 
torque  magnitudes.  That  point  in  the  run  was  where  the  nozzle  contacted  the  flat 
portion  of  the  slipway  back  wall.  It  was  noted  in  Chapter  Three  that  the  mock-up 
was  slightly  different  in  configuration  than  an  actual  slipway.  This  flat  back  wall 
was  the  largest  difference.  With  a  discontinuous  transition,  or  corner,  between  the 
side  wall  and  the  receiver,  the  axis  of  the  nozzle  encountered  a  condition  in  which 
the  nozzle  axis  becomes  perpendicular  to  the  wall,  but  off-set  in  the  y  direction  from 
the  receiver  opening,  i.e.  stuck  in  a  corner.  The  manipulator  was  unable  to  ac¬ 
commodate  this  obstacle,  therefore  it  remained  in  that  position  building  up  torques 
until  the  trajectory  time  expired.  This  shows  that  this  controller  can  not  surmount 
non-linear  impedances,  yet  it  will  remain  stable  in  that  condition. 

5.9  Summary 

This  chapter  has  demonstrated  three  DOF  compliant  refueling  with  impedance 
control.  Tuning,  or  varying  the  second  order  parameters  revealed  that  this  control 
law  can  and  does  function  over  a  wide  range  of  conditions.  Filtering  of  force  and 
velocity  terms  was  used  to  create  a  smoother  scenario  in  which  to  evaluate  friction 
compensation  Friction  compensation  schemes  made  little  improvement  over  the 
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uncompensated,  £  =  .174  case.  Data  was  presented  which  indicates  that  impedance 
control  will  provide  compliance  at  much  higher  velocities.  Finally,  the  linear  surface 
tracking  limitations  of  the  control  law  were  exposed. 
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VI.  Conclusions  and  Recommendations 


6. 1  Conclusions 

Three  degrees  of  freedom  compliant  motion  has  been  proven  and  demonstrated 
on  the  half-scale  Universal  Aerial  Refueling  Receptical  Slipway  Installation  mock- 
up.  In  addition,  this  research  has  provided  the  following  contributions  to  AFIT 
compliant  motion  research: 

•  Tuning.  Impedance  parameters  can  be  tuned  to  achieve  desired  performance 
over  a  wide  range  of  impedance  conditions 

•  Filtering.  Simple  but  effective  filtering  techniques  improved  the  overall  quality 
of  commanded  torque.  Both  force  and  velocity  were  filtered. 

•  Friction  Compensation.  The  current  friction  model  has  been  shown  to  provide 
no  performance  improvement 

The  results  of  this  thesis  provide,  in  many  ways,  a  capstone  to  the  AFIT  robotics 
laboratory  research  in  compliant  motion.  Achieving  three  DOF  capability  allows 
for  investigation  of  a  wide  range  of  assembly  related  tasks.  Compliant  control  can 
and  should  be  applied  in  any  peg-in-the-hole  assembly  tasks.  Specifically,  compliant 
control  should  be  used  in  future  robotic  refueling  prototype  efforts. 

6.S  Recommendations 

Often,  research  of  this  kind  creates  more  questions  them  answers.  This  the¬ 
sis  is  no  exception.  Perhaps  the  biggest  ruestion  remaining  is  how  to  improve  or 
smooth  the  compliant  trajectory.  The  persistent  stop-start  motion  problem  is  not 
well  posed.  Until  it  is,  attempts  to  compensate  for  the  phenomenon  will  reach  limited 
success.  Preliminary  research  with  adaptive  techniques  suggests  that  adaptive  fric¬ 
tion  compensation  will  provide  improved  performance  over  the  friction  model  used. 
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Additionally,  interface  forces  and  their  effects  may  play  a  large  role  in  creating  or 
impeding  a  smooth  continuous  constrained  motion. 

Another  interesting  aspect  to  consider  is  the  need  for  additional  compliant  de¬ 
grees  of  freedom.  What  benefits  can  be  derived  from  a  full  six  degree  of  freedom 
manipulation  task?  Can  active  and  passive  compliance  be  integrated  into  the  same 
task  and  perform  the  refueling  demonstration?  What  are  the  effects  of  even  higher 
velocity  on  the  results  provided  here.  That  is,  can  compliant  tasks  be  performed  as 
well  at  much  larger  velocity.  The  following  is  a  summary  of  recommendations  for 
future  research  in  compliant  motion  and  some  of  the  issues  its  study  has  raised: 

•  resolve  joint  one  data  corruption 

•  identify  the  nature  of  the  stair-step  motion 

•  investigate  using  adaptive  techniques  to  reduce  or  eliminate  undesired  behavior 

•  increase  to  six,  the  compliant  degrees  of  freedom  for  the  same  refueling  task 

•  create  more  precise  ways  to  assure  smooth  velocity  profiles. 

•  perform  the  same  test  a  higher  velocities 

•  perform  the  refueling  demonstration  at  higher  sample  rates  and  velocities 

•  implement  a  more  rigid  fixture  which  requires  the  entire  compliant  nature  to 
be  handled  by  the  manipulator 

•  develop  a  more  precise  way  to  consistently  repeat  the  experimental  runs;  i.e., 
upgrade  to  PUMA  calibration  routines. 

The  key  to  future  compliant  motion  studies  is  to  have  deem  accurate  inputs  and  more 
consistent  test  environment.  By  providing  a  repeatable  laboratory  environment,  the 
effect  of  slight  modifications  can  be  better  correlated.  Problems  such  as  the  joint  one 
data  corruption,  and  PUMA  calibration  point  variations  act  to  cloud  other  issues 
such  as  the  jerky  stair-step  motion. 
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